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SECTION  I 


INTRODUCTION 


OVERVIEW 

A time  division  multiple  access  (TDMA)  communications  system, 
which  supports  the  communications  among  all  elements  within  line- 
of-sight  of  one  another,  offers,  with  its  inherent  ranging  capa- 
bility, the  potential  for  increased  position  accuracy  for  each  parti- 
cipant. In  the  Electronic  Grid  Integration  Program,  the  combination 
of  Loran  inputs  with  the  time-of-arrival  (TOA)  inputs  from  the  TDMA 
communications  network  was  examined.  This  paper  defines  the  software 
design  relating  to  the  position  location  and  synchronization  algorithm 
in  use  during  the  final  flight  tests  of  that  program. 

The  algorithm  is  basically  similar  to  that  used  in  the  computer 
simulation  described  in  Reference  1.  There  are  some  important  excep- 
tions , however.  The  Mlive,f  program  maintained  only  a single  clock 
model.  This  required  that  the  TDMA  system  master  synchronize  to  the 
Loran  net,  so  that  passive  range  measurements  on  Loran  signals  could 
be  based  on  the  system  clock  model.  This  would  limit  an  operational 
system  to  the  use  of  TDMA  data  plus  one  "other"  kind  of  data  source. 

In  reality,  it  would  be  a fairly  simple  matter  to  maintain  several 
different  clock  models  so  as  to  remove  such  a limitation.  A sophis- 
ticated control  logic,  which  included  reference  feedback,  was  quite 
probably  better  left  out.  While  it  was  shown  in  Reference  1,  that 
in  particular  situations  some  advantage  was  gained,  it  must  be  con- 
fessed that  the  implications  of  feedback  control  applied  to  a multi- 
element system  are  not  fully  appreciated. 

Omitted  from  both  the  simulation  and  the  "live"  program,  is  a 
position  search  phase.  This  would  be  a definite  requirement  in  an 
operational  system,  as  it  simplifies  the  start-up  process  (from  an 
operator  point  of  view)  and  warns  of  possible  ambiguous  position 
solutions. 

The  program  is  a natural  and  logical  outgrowth  of  the  recursive 
navigation  simulation  (Reference  2)  development  which  was  begun  early 
in  1969.  The  salient  aspects  of  recursive  navigation  as  applied  to 
the  Electronic  Grid  Integration  Program  are  discussed  in  the  pages 
immediately  following  in  this  section.  In  Section  II,  the  theoretical 
considerations  of  the  algorithm  are  discussed  in  some  detail.  Program 
interrupts,  by  which  means  the  cycling  process  is  maintained,  are 
introduced  in  Section  III.  The  routines  and  subroutines  of  the  posi- 
tion location  and  synchronization  algorithm  are  presented  in  Sections 
IV  and  V.  Finally,  an  alphabetic  parameter  listing  is  provided  in 
Section  VI. 
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FRAME  OF  REFERENCE 


The  frame  of  reference  for  navigation  within  the  recursive  navi- 
gation scheme  is  an  ellipsoid  of  revolution.  Each  unit,  or  element 
of  the  system,  is  represented  as  being  at  an  altitude  Z above  the 
point  0,  X (latitude,  longitude)  on  the  surface  of  the  ellipsoid. 

The  ellipsoid  is  taken  to  be  the  1966  Smithsonian  Standard  Earth, 
usually  referred  to  as  SAO  1966  (Reference  3) . This  ellipsoid  is 
defined  as  having  a semi-major  axis  (equatorial  radius)  of  a * 6,378,165 
meters,  and  a flattening  defined  by  1/f  = 298.25.  Airborne  units  are 
assumed  to  have  a velocity  vector,  speed  V and  heading  H,  oriented  in 
a plane  tangent  to  the  surface  at  the  point  0,  X.  The  relation,  one 
nautical  mile  = exactly  1852  meters , is  assumed. 


PERIODIC  POSITION  REPORT 

The  key  to  recursive  navigation  is  the  periodic  position  report 
which  each  unit  transmits  once  per  frame  in  its  assigned  slot  within 
the  time  division  multiple  access  (TDMA)  communications  network.  This 
report  always  contains  position  (no  matter  how  poorly  known)  and  it  is 
always  transmitted  once  each  frame  (unless  in  the  QUIET  mode)  subse- 
quent to  the  receipt  of  a start  command  and  slot  assignment.  The 
report  also  contains  the  unit  state  and  uncertainty  matrix,  which 
indicate  the  suitability  of  the  unit  as  a data  source.  The  former 
provides  a simple  yes/no  condition,  while  the  latter  defines  in  what 
manner  the  data  can  best  be  utilized. 

During  the  frame,  each  unit  endeavors  to  determine  as  precisely 
as  possible  the  proper  time  to  transmit  the  next  report,  and  the  posi- 
tion and  other  information  it  should  contain.  Loran  inputs  and/or 
position  reports  from  other  TDMA  units  will  be  utilized  in  that  deter- 
mination. Other  information  in  the  position  report  will  include  iden- 
tification, task,  slot  number,  speed,  heading,  and  altitude. 


UNIT  TASK  DESIGNATION 

There  are  four  different  unit  task  designations  corresponding  to 
the  four  different  types  of  units  in  the  TDMA  system.  They  are: 

MASTER  - provides  the  system  time  and  position  reference 
REFERENCE  - a sited,  stationary  ground  station 
GROUND  - an  unsited  ground  station,  stationary  or  quasi- 
stationary 

AIRBORNE  - any  unit  in  motion 
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The  MASTER  monitors  the  system  and  sends  feedback  messages 
causing  collective  adjustments  in  timing  and  position  estimates  by 
the  GROUND  and  AIRBORNE  system  members. 

A REFERENCE  unit  adjusts  timing  estimates  only;  its  position  is 
assumed  known. 

A GROUND  unit  has  a zero  velocity  vector.  It  adjusts  timing 
and  position  estimates. 

An  AIRBORNE  unit  has  a non-zero  velocity  vector.  It  adjusts 
timing,  position  and  velocity  estimates. 


MODES  OF  OPERATION 

There  are  three  possible  modes  of  operation  for  any  unit  except 
MASTER.  These  are: 

RANGING  - utilizes  round  trip  ranging 

NORMAL  - utilizes  passive  one-way  ranging 

QUIET  - same  as  NORMAL  except  does  not  transmit 

The  operating  mode  is  determined  under  program  control  which  con- 
siders a preferred  mode  based  on  available  data  sources  as  well  as  the 
mode  selected  by  manual  switch  action.  There  are  four  possible  switch 
selections.  These  are  RANGING,  NORMAL,  QUIET  and  UNSELECTED.  With 
the  latter  switch  setting,  the  program  will  operate  in  the  preferred 
mode. 


In  the  RANGING  mode,  a unit  periodically  interrogates  others  to 
obtain  round  trip  ranges.  In  this  mode,  position  location  and  time 
synchronization  are  performed  independently.  Unless  specifically 
selected,  this  mode  is  used  only  when  the  number  of  available  data 
sources  cannot  support  NORMAL  mode  operation. 

In  the  NORMAL  mode,  periodic  position  reports  and  Loran  inputs 
are  used  to  determine  one-way  ranges.  Adjustments  to  position  and 
timing  estimates  are  determined  simultaneously. 

The  QUIET  mode  is  similar  to  the  NORMAL  mode  except  that  the 
local  unit  does  not  transmit. 

Initially,  the  QUIET  mode  is  forced  upon  all  units  except  MASTER, 
regardless  of  switch  selection,  to  prevent  interference.  Not  until  at 
least  one  position  report  has  been  received  from  a source  claiming 
synchronization  is  a change  to  the  NORMAL  or  RANGING  operating  mode 
permitted. 
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PHASING  SCHEME 


The  recursive  process  of  updating  the  uncertainty  matrices  and 
the  state  vector  modifies  previous  assumptions  of  state  based  on  cur- 
rent measurements.  This  requires  an  initializing  process,  so  that 
the  recursion  can  get  under  way.  The  initialization  is  divided  into 
three  short  phases  followed  by  the  final  recursive  phase.  Briefly, 
the  phasing  scheme  is: 

(0)  Gross  Sync  — to  obtain,  or  reacquire,  rough  clock 
synchronization ; 

(1)  Position  Search  — to  obtain  a "reasonably  close" 
position  estimate,  and  to  warn  the  operator  of 
possible  ambiguous  position  solutions ; 

(2)  Start  Up  — to  provide  the  initial  values  for  the 
time  and  position  states  and  the  associated  covari- 
ance matrices;  and 

(3)  Recursive  — to  modify  previous  assumptions  of  state 
based  on  current  measurements , and  update  the  uncer- 
tainty matrices  and  the  state  vector. 

The  position  search  phase  was  never  programmed.  In  its  place,  a 
"reasonably  close"  starting  position  must  be  manually  entered  during 
program  initialization  (reasonably  close  can  be  taken  to  mean  within 
5 or  10  miles  and  in  the  right  quadrant,  i.e.,  the  appropriate  general 
direction  from  the  data  sources).  This  was  satisfactory  for  the  pur- 
poses of  Project  7200;  however,  in  an  operational  system,  the  position 
search  phase  is  an  absolute  necessity.  Position  search  consists  of 
iterations  over  the  same  set  of  observations,  from  several  well  chosen 
starting  points,  to  find  a convergent  solution,  or  possibly  ambiguous 
conver  gent  so lutions . 


DATA  PRIORITY 

A two  level  data  priority  scheme  is  followed  which  utilizes  the 
MIS  indicator.  (Originally,  the  indicator  literally  meant  "Master- 
In-Sight",  but  evolved  to  mean  "Master-In-Control". ) All  units  will 
process  position  reports  only  from  sources  with  the  MIS  indicator  set 
to  one.  Airborne  and  ground  units,  in  fact,  set  MIS  to  one  in  any 
frame  that  the  master  position  report  is  received.  Reference  units, 
however,  always  indicate  MIS  on  in  their  position  report.  The  master 
then  monitors  only  position  reports  with  MIS  on  for  feedback  purposes. 
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The  first  level  of  data  priority  includes  all  interacting  ele- 
ments contributing  to,  and  under  the  influence  of,  master  feedback 
control.  The  second  level  includes  non-interacting  elements  outside 
of  the  master  unit’s  influence,  which  utilize  first  level  data  pri- 
ority sources.  This  simple  priority  scheme  was  quite  adequate  for 
the  limited  scope  of  the  Project  7200  experimental  area.  However, 
an  operational  system  should  extend  the  scheme  to  at  least  four 
levels  of  data  priority,  as  described  in  References  1 and  2. 


UNIT  STATE  (OR  DATA  STATUS) 

There  are  four  possible  states  that  a unit  may  be  in  (and  thus 
his  data,  if  he  transmits).  The  states  are  determined  automatically 
under  program  control.  They  are: 

UU  - time  and  position  Unknown 

UP  - time  Unknown,  Position  known 

SU  - time  Synchronized,  position  Unknown 

SP  - time  Synchronized,  Position  known 

AIRBORNE  and  GROUND  units  will  start  in  state  UU.  Normally  they 
will  progress  directly  to  state  SP,  though,  on  occasion,  it  may  be 
desirable  to  achieve  status  UP  or  SU  in  the  RANGING  mode. 

REFERENCE  sites  will  start  in  state  UP.  If  the  master  unit  is 
being  received,  they  will  process  only  master  data.  Failing  this,  if 
one  or  more  references  are  being  received,  a reference  will  process 
only  other  reference  data.  If  no  master  or  reference  data  are  avail- 
able, then  they  will  process  ground  and  airborne  data. 


STATE  CHECK 

Initially,  and  until  state  SP  (Synchronized,  Position  known)  is 
attained  and  the  unit  is  operating  in  the  NORMAL  mode,  it  is  attempted 
to  upgrade  the  unit  state  changing  the  mode  of  operation,  if  desirable 
and  permitted.  Then,  while  in  state  SP,  mode  NORMAL,  it  is  attempted 
to  maintain  the  status  quo.  If  analysis  of  the  data  sources  indicates 
that  state  cannot  be  upgraded  (or  maintained  in  SP)  in  the  present 
mode,  but  can  be  upgraded  or  maintained  in  another,  then  the  mode  of 
operation  will  be  changed,  unless  this  conflicts  with  the  mode  switch 
selection.  If  data  become  sparse,  the  RANGING  mode  may  be  attempted 
in  order  to  achieve  or  maintain  state  SP. 

Two  counters  are  maintained  for  the  purpose  of  upgrading  and  down- 
grading status,  both  of  which  represent  a length  of  time  spent  in  some 
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condition.  Associated  with  each  counter  are  transition  values , which , 
when  attained,  will  cause  a change  in  state  or  mode.  The  counters  are 
stepped,  or  reset,  in  conjunction  with  time  and  position  solution 
indicators,  TN  and  PN.  These  are  set  to  +1  or  0 during  end  of  frame 
processing  to  indicate  if  a solution  was  obtained.  The  indications 
are: 


TN 


1 

0 


satisfactory  time  solution 
insufficient  data  or  poor  geometry 


PN 


1 

0 


satisfactory  position  solution 
insufficient  data  or  poor  geometry 


TN  and  MIS  are  set  to  zero,  should  the  mean  time  discrepancy  exceed 
program  limits.  In  states  SU  and  SP,  a normal  position  solution  may 
be  obtained  with  only  two  data  sources. 

CT  Counter 


A unit  in  time  state  S,  counts  (negatively)  consecutive  frames 
with  no  time  solution.  The  counter  is  reset  to  -1  in  any  frame  with 
a satisfactory  solution  (TN  = 1).  Insufficient  data  (TN  = 0)  causes 
the  counter  to  be  stepped  downward,  and  if  it  reaches  -CTU,  the  time 
state  is  changed  to  U,  and  the  phase  is  changed  to  gross  sync. 

In  time  state  U,  insufficient  data  continues  to  step  the  counter 
downward,  and  should  it  reach  -CTQ,  the  QUIET  mode  is  forced  on  the 
unit.  A single  satisfactory  solution  (TN  = 1)  resets  the  counter  to 
+1  and  starts  the  resynchronizing  process,  during  which  satisfactory 
solutions  step  the  counter  up  and  insufficient  data  steps  the  counter 
down  (skipping  zero).  Upon  reaching  +CTS,  the  time  state  is  changed 
to  S. 


Initially,  the  unit's  mode  is  QUIET  (except  MASTER)  and  CT  is 
zero.  However,  a receipt  of  a single  synchronized  datum  is  sufficient 
to  initiate  the  synchronization  process  in  either  the  NORMAL  or  RANGING 
mode. 

CP  Counter 


In  position  state  U,  the  counter  is  stepped  up  in  any  frame  that 
position  data  is  processed  satisfactorily  (PN  - 1) , and  stepped  down 
(not  below  zero)  when  insufficient  data  occurs  (PN  =0).  If  the 
counter  reaches  CPK,  the  state  is  changed  to  P. 
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Airborne  units  in  position  state  P use  this  counter  to  count 
consecutive  frames  with  no  satisfactory  solution  (PN  = 0) . The 
counter  is  reset  to  zero  in  any  frame  that  position  data  are  pro- 
cessed satisfactorily  (PN  =1).  If  the  counter  reaches  +CPU,  the 
state  is  changed  to  U,  and  the  position  phase  is  returned  to  start 
up. 


Ground  units,  having  achieved  state  P,  remain  there. 


DATA  SOURCE  TABLE 

Each  unit  maintains  a data  source  listing  and  updates  it  each 
frame.  Whenever  a position  report  is  received,  the  sender  identi- 
fication, arrival  time,  slot  number,  position  and  other  pertinent 
information  is  entered  into  the  table.  Messages  other  than  position 
reports  are  not  entered.  Units  will  use  the  table  to  determine  pos- 
sible mode,  or  state  change,  and  to  determine  sources  worthy  of  inter- 
rogation in  the  ranging  mode. 

In  the  Project  7200  experimental  area,  the  table  was  indexed  by 
prestored  ID,  since  only  a small  number  (10)  of  potential  sources 
existed.  In  an  operational  system  it  would  be  pointless  and  costly 
to  record  data  on  every  position  report  received.  However,  it  will 
be  useful  to  maintain  a time  ordered  list  of  from  eight  to  sixteen 
potential  sources  to  be  interrogated  in  the  ranging  mode.  Quite 
likely,  the  data  source  table  could  be  a part  of,  or  an  extension  of 
the  ranging  interrogation  table.  (See  the  Ranging  Interrogation  Set- 
Up  Subroutine  in  Section  V.) 
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SECTION  II 


THEORETICAL  CONSIDERATIONS 


GENERAL 

Each  unit  maintains  an  assumed  state  vector  and  a covariance 
matrix  of  the  uncertainty  of  the  estimates  of  system  time  and  posi- 
tion. Taking  x and  y in  the  direction  of  positive  west  longitude  and 
north  latitude,  these  can  be  represented  as: 


t 

t 


A 


s = 


x 

X 


C 


2 

0 

XX 


(1) 


y 

y 

z 


All  but  the  time  variables  are  transmitted  each  frame*  The  variables 
time  and  time-rate,  t and  t,  in  fact  determine  when  the  transmission 
occurs  and  serves  as  a basis  for  making  time-of-arrival  measurements 
on  other  position  reports.  If  any  unit  is  to  utilize  Loran  inputs, 
this  then  requires  that  the  TDMA  system  master  synchronize  to  the 
Loran  net.  This  is  no  problem;  however,  alternatively,  separate  clock 
models  could  be  maintained  — one  for  system  time  and  one  for  Loran 
time.  The  velocity  variables  apply  only  to  aircraft  and  are  in  terms 
of  speed  and  heading,  V and  H.  The  state  vector  and  the  uncertainty 
matrix  are  updated  at  the  end  of  each  frame,  based  on  the  data  received 
during  the  frame.  Altitude  is  not  filtered  — it  represents  the  cur- 
rent air  data  input  or  manual  entry,  as  applicable.  For  convenience 
of  notation,  the  covariance  matrix  will  be  written  as: 


stt 

stx 

sty 

stx 

sxx 

sxy 

sty 

sxy 

syy 
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To  support  the  process,  each  unit  maintains  a clock  covariance 
matrix  correlating  the  uncertainty  in  system  time  and  time-rate. 


tt 


tt 


tt 


tt 


(3) 


This  is  updated  recursively  at  the  end  of  each  frame  based  on  data 
received  during  the  frame.  Also,  airborne  units  maintain  the  posi- 
tion covariance  matrices 


C = 
x 


2 2* 

2 

2 

a 

a • 

a 

o • 

XX 

XX 

c = 

yy 

yy 

2 

2 

y 

2 

2 

o • 

a*  • 

a • 

a*  • 

XX 

XX 

yy 

yy 

d 

(4) 


relating  position  and  velocity  in  the  x and  y (west  and  north)  direc- 
tions. Ground  units,  having  no  velocity  vector,  simply  update 
and  tfyy,  which  are  the  same  as  the  corresponding  elements  sxx  and  syy 

of  the  C matrix.  The  three  matrices,  C , C , and  C , will,  for  con- 

’t  x v’ 

venience,  be  written 


at 

bt* 

* 

ax 

bx" 

ay 

by 

bt 

- 

ct 

bx 

cx 

by 

cy 

d 

(5) 


These  matrices  are  not  transmitted,  but  are  used  in  the  process  of 
computing  the  six  different  elements  of  the  uncertainty  matrix  that 
is  transmitted. 


MEASUREMENT  AND  ERROR  ESTIMATION 

The  position  report , transmitted  at  time  t by  each  unit , contains 
(at  least)  the  three  position  elements  0,  X and  Z,  latitude,  longitude 
and  altitude,  and  the  six  covariance  elements  stt,  stx,  sty,  sxx,  sxy 
and  syy.  Collectively,  these  position  reports  become  potential  obser- 
vations for  every  other  unit  in  the  system.  Each  unit  references  his 
observations  to  a plane  tangent  to  the  spheroid  at  his  assumed  position, 


11 


so  that  differences  of  longitude  and  latitude  become  differences  in 
x and  y.  Differential  corrections,  determined  in  the  plane  in  terms 
of  x and  y are  then  converted  to  adjustments  in  longitude  and  lati- 
tude. Details  of  these  conversions  are  contained  in  Parameters  and 
Geometry  subroutines  and  will  be  omitted  here. 

In  Normal  mode  operation,  an  observation  is  of  the  form 


6i  = (ti  “ ~ 

where  vp  is  the  electromagnetic  velocity 
the  observation  is  just 


x)2  + (y±  - y)2  + (z±  - z)2 
of  propagation.  More  simply. 


0 


i 


Rt^  - Rc^ 


(6) 


(7) 


that  is,  time  measured  one  way  range  less  the  apparent  position  dif- 
ference, or  computed  range. 

Defining  a unit's  transmission  time  error  as 


et 


T — t 

(proper)  (assumed) 


(8) 


the  range  error  due  to  error  in  time  will  be 
er  = et*vp 

and,  if  position  error  is  defined  as 


9 

ex 

r 

X 

x' 

ey 

j 

y 

(assumed) 

Y 
> . 

(true) 


(9) 


(10) 
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then  the  observation  is  related  to  the  state  error  by 


!±-[l  cx±  cyt j 


er 

ex 

ey 


(11) 


where 


CXi  = ^xi  “ x)/Rc1 

cyi  = (y±  - y)/Rc± 


(12) 


A term,  WT^,  sensitive  to  the  type  of  source  is  determined  by  the 
receiving  element.  The  TDMA  system  master,  reference  units,  and  Lor an 
inputs  are  given  the  value  WT^  = 1;  ground  units,  WT^  = 2;  and  air- 
borne units,  WT^  = 4. 

(While  the  above  simple  assignment  scheme  may  be  satisfactory  for 
the  small  scale  test  area  of  Project  7200,  in  an  operational  system  it 
will  be  necessary  to  set  WT^  proportional  to  the  number  of  sources 
being  utilized.  For  example: 

If  the  data  source  is  a ground  unit,  WT,  = 1 + N/6 

1 (12a) 

If  the  data  source  is  airborne,  then  WT^  = 1 + N/3 

This  prevents  a large  number  of  airborne  and  ground  units  from  swamp- 
ing the  master  and  reference  data.  Loran  data  could,  and  probably 
should  be  assigned  values  of  WT^  that  are  proportional  to  the  apparent 
time-of-arrival  uncertainty  of  each  source.  The  signal-to-noise  ratio 
might  well  be  used  for  this  purpose.) 

Each  position  report  to  be  utilized  (some  may  be  screened  out)  is 
given  a weight,  according  to 

2 2 

?i  = WTi  + stt  + 2cxistxi  +2cy^,sty^  + cxisxxi  + 2cx^cyisxyi  + cy^syy^  (13) 
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which  is  inverted  to  form  the  weighting  factor 


wi  = 1/C±  (14) 

The  inverse  weights  form  a diagonal  weighting  matrix 


w. 


w 


2 


W - 


w 

n 


(15) 


while  the  observations  and  direction  cosines  form  the  matrices 


V 

1 

CX1 

cyi 

e = 

02 

• 

• 

# 

J = 

1 

4 

• 

4 

» 

cx2 

• 

• 

# 

# 

Cy2 

# 

# 

9 

# 

• 

e 

n 

b t 

4 

1 

# 

cx 

n 

# 

cy 

The  minimum  variance  solution  for  the  estimated  error  vector  is  given 
by 


e = (JTWJ)  *JTW6  (17) 


and  the  variances  of  the  error  estimates  are  provided  by  the  diagonal 
elements  of  (JiWJ)-1  (Reference  4). 
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As  observations  arrive,  they  are  collected  in  running  sums. 


N 

= 

N 

+ 

wi 

NS 

= 

NS 

+ 

i 

cx 

= 

cx 

+ 

Wi'CXi 

cy 

= 

cy 

+ 

Vcyi 

cxy 

= 

cxy 

+ 

wi*cx±*cyi 

CX2 

= 

CX2 

+ 

Vcxi2 

CY2 

= 

CY2 

+ 

Wi-cy^ 

d 

= 

d 

+ 

V0i 

dx 

= 

dx 

+ 

w^*  cx^*0^ 

cy 

= 

cy 

4* 

Wi*Cyi*0i 

(18) 


At  the  end  of  a frame  then,  these  sums  represent  the  six  elements  of 
(J^WJ)  and  the  three  elements  of  J^W0.  Representing  the  estimated 
error  vector  e as  the  differential  corrections  DR,  DX  and  DY  in  range 
and  position,  equation  (17)  now  appears  as 


-1 


DR 

N 

CX 

cy 

d 

DX 

= 

cx 

CX2 

cxy 

• 

dx 

(19) 

DY 

cy 

cxy 

CY2 

J 

dy 

At  ground  and  airborne  units,  the  single  fix,  independent  estimate  of 
range  error,  DR,  is  found  as  usual  by 


El  = 

CX2 • CY2 

- (cxy)2 

E2  = 

cy*cxy 

- cx*CY2 

E3  = 

cx*cxy 

- cy • CX2 

V 

N*E1  + 

cx*E2  + cy*E3 

(20) 


15 


then 


DR  = (Eltd  + E2-dx  + E3-dy)/V  (21) 

which,  upon  division  by  vp,  propagation  velocity,  becomes  the  esti- 
mated system  clock  error  in  units  of  time.  This  is  usually  referred 
to  as  the  (3  x 3)  solution  for  time.  Its  variance  is  given  by 

°3l  = El/V  (22) 


Position  estimates  DX  and  DY  may  be  obtained  from  the  (3x3), 
which  continues  after  computing  DR, 


X2 

= N*CY2  - 

(cy)2 

X3 

= cx*cy  - 

N cxy 

Y3 

= N-CX2  - 

(cx)2 

then 

DX  = (E2*d  + X2*dx  + X3*dy)/V 
DY  = (E3*d  + X3*dx  + Y3*dy)/V 
and  the  associated  variances  are 


(23) 


(24) 


°3x  ‘ X2/V 

°3y  ‘ Y3/V 

o - 2 — +X3/V 


(25) 


These  (3  x 3)  position  estimates  will  be  obtained  in  the  Normal  mode, 
during  the  position  search  and  start-up  phases  at  air  and  ground  units 
and  during  the  recursive  phase  at  ground  units. 
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Airborne  units  in  Normal  mode,  obtain  position  estimates  from 
the  time  dependent  (2  x 2)  solution,  while  in  the  recursive  phase. 
That  is 

DX  - (dx*CY2  - dycxy)/El 
DY  = (dy*CX2  - dx-cxy)/El 
the  associated  variances  being 


= CY2/E1 

a.2  = CX2/E1 

2y 


2xy 


= -cxy/El 


Reference  units  obtain  the  time  error  simply  by 
DR  = d/(N*vp) 
and  its  variance  is 


(26) 


(27) 


(28) 


aL2  = 1/N  (29) 

The  Master  unit,  which  monitors  all  position  reports  with  the  MIS 
indicator  set  to  one,  also  uses  equations  (26)  and  (28)  to  compute  the 
apparent  system  error  in  position  and  time.  These  error  estimates  are 
then  smoothed,  and  possibly  limited,  to  produce  the  feedback  items  TF, 

XF  and  YF,  which  are  transmitted  with  the  master  position  report. 

In  the  ranging  mode  of  operation  a time  observation  is  of  the  form 


Dt.  = [(ti  - to(i))  - (t.  - to(j))]/2  (30) 

where  tj  refers  to  the  time  measurement  made  by  the  unit  interrogated 
and  t^  refers  to  the  measurement  made  by  the  local  unit  on  the  ranging 
reply.  If  either  unit  is  in  motion,  and  if  speed  and  heading  informa- 
tion, V and  H,  is  included  in  the  position  report,  an  adjustment  fac- 
tor is  added  to  Dt.  which  is  of  the  form 

l 
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. t (i)  - t (J) 

t = t(Vx  + Vjsln  Hj^cxi  + (yy  “ Vjcos  Hj)cyi]  (31) 

th 

The  time  observation  from  the  1 source  is  weighted  according  to 

= WT^  + stt^  + 2cx^stx^  + 2cy^sty^  (32) 

which  is  inverted  to  form  the  weighting  factor 

= l/^i  (14) 

As  the  time  observations  arrive  they  are  collected 
Nt  = Nt  + w 

(33) 

dt  = dt  + w^*Dt^ 

Then,  at  the  end  of  the  frame,  the  estimated  clock  error,  in  units  of 
time  is 

DR  = dt/Nt  (34) 

and  the  solution  variance  is 

aR2  = l/2Nt  (35) 

The  position  observation,  in  the  ranging  mode  is  of  the  form 


Dp±  = H[t±  - tQ(i)  + tj  - tQ(j)]vp  - ^(x^x)2  + (y^y)2  + (zj-z)‘ 
and,  in  ranging  the  position  observation  is  weighted  by 


(36) 


2 2 
= WT_^  + cx^xx.^  + 2cx_),cyisxyi  + cyisyyi 


(37) 
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which  is  inverted  to  form  the  weighting  factor 

= 1/ (14) 

The  observations  are  collected  in  the  same  running  sums  as  with  the 
normal  mode  (equation  set  (18)) • The  position  solution  is  found  as 
in  normal  from  the  (2x2),  equation  (26),  and  the  variances,  similar- 
ly, equation  (27). 


INITIALIZING  THE  RECURSIVE  PROCESS 

Since  the  Kalman  filter  requires  prior  information,  it  is  neces- 
sary to  go  through  a start-up  process  to  get  initial  values.  In  this 
application,  the  problem  is  treated  as  three  independent  two-variable 
processes.  One  for  time,  t and  t,  and  two  for  position  x and  x,  and 
y and  y.  Only  with  airborne  units  are  all  three  processes  fully 
applicable. 

The  start-up  process  can  be  stated  as  follows,  for  the  time  vari- 
ables: assume  that  an  initial  clock  state 


S(o)t 


(38) 


has  been  established.  Each  estimate  of  time  error,  DR^,  obtained  at 
each  end  of  frame  while  in  the  start-up  phase,  is  related  to  the  ini- 
tial error  in  assumed  clock  state  through  the  J transition  matrix 

o 


DR 

1 T1 

1 

1 

DR„ 

1 T0 

2 

= 

2 

.°y 

-1  \ 

et 


et 


that  is 


DR  = J 

o 


e 

o 


(39) 


(40) 
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where  is  the  interval  since  S(o)t  was  established.  Associated 
with  each  DR^  is  the  solution  variance,  a^,  which  is  used  to  weight 
the  error  estimate  in  a manner  identical  to  the  weights  given  obser- 
vations. That  is. 


w = Ho2  (41) 

1 

which  form  the  diagonal  weighting  matrix 


(42) 


Now,  DRjj  is  the  most  recent  observation  and  tjj  is  the  time  since  the 
initial  state,  S(o)t,  was  established.  DRjj  is  in  fact  the  last  error 
estimate  that  will  be  made  in  the  start-up  phase.  An  adjustment  will 
be  made  to  the  initial  state  which  will  then  be  extrapolated  an  inter- 
val forward  to  provide  the  initial  state  S(n/n)t  for  the  recursive 
phase.  That  state  is 


S(n/n)fc 


S(o)  + (J  TWJ  )-1*J  twdr 
t o o o 


(43) 


and  the  initial  covariance  is 


C(n/n)fc 


at 

bt 

bt 

ct 

(44) 
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where 


at  -bt 

-bt  ct 


(J  TWJ  )_1 
o o 


(45) 


Data  is  computed  and  saved  in  the  form  of  running  sums  until  the 
N observations,  spanning  the  required  frames,  have  been  obtained. 

Then  S(n/n)  and  C(n/n)  are  computed.  The  computations  are: 

Obtain  DR^  for  ranging  or  normal  mode 
2 

Set  w = 1/a 

1 i 

which  is  V/El  in  normal  (non-reference) 
or  N reference  in  normal 
or  2Nt  in  ranging  mode. 

Then 

6 = (E  w±)(E  w^x/)  “ (2  wi*Ti^2 
at  = (E  w^*x/)/$ 
bt  = (E  w^*x^)/6 
ct  = (E  w^)/6 

and 

At  = at*Ew.*DR.  - bt* Ew. *T. *DR. 

li  l i l 

Ad  = ct^Ew^'X^DR^  - bt*Ew^*DR^ 
become  the  corrections  to  be  applied  to  S(o)t> 


(41) 


(46) 


(47) 
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Then 


S(n/n)t 


C(n/n)fc 


0 1 

at  bt 

bt  ct 


(48) 


(49) 


The  start-up  process  is  identical  aboard  an  aircraft  for  the  posi- 
tion coordinates  x and  y,  with  appropriate  substitutions  in  equations 
(38)  through  (47).  The  manner  of  applying  the  corrections  AX,  AX,  AY 
and  will  follow  the  pattern  of  equations  (74)  through  (77)  , which 
converts  the  corrections  to  changes  of  latitude  and  longitude. 

For  a ground  unit,  equation  set  (46)  for  position  reduces  to  simply 


ax  = 

1/Sw± (x) 

Ax  = 

0:wi-DXi)/ax 

ay  = 

1/Ewi(y) 

> 

n 

(Ewi-DYi)/ay 

(50) 


KALMAN  FILTER 

The  Kalman  filter  provides  the  recursive  formulas  for  updating 
the  state  vector  and  the  uncertainty  matrices.  Again,  the  problem  is 
treated  as  three  independent  two-variable  processes.  One  for  time,  t 
and  t,  and  two  for  position  x and  x,  and  y and  y,  where  only  with  the 
airborne  units  are  all  three  processes  fully  applicable. 

The  recursion  formulas  can  be  stated  as  follows,  for  the  time 
variables. 
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t 


If  at  time  n,  the  clock  state  is  S(n/n)  = 


It. 


tt 


tt 


and  its  covariance  is  C(n/n)  = 


tt 


2 

o • • 

tt. 


(51) 


(52) 


then  the  predicted  clock  state  at  time  n+1,  based  on  data  available  at 
time  n , is 


S(n+l/n)  = A*S(n/n)  where  A 


1 x 

0 1- 


(53) 


and  where  t is  the  time  interval  from  n to  n+1. 

2 

If  DR  is  the  minimum  variance  time  error  estimate  and  a 3^  the 
solution  variance,  these  items  are  used  to  bring  forward  the  covari- 
ance matrix  and  state  vector. 


C (n+1 /n+1) 


|(AT)-1C  1(n/n)A-1  + 


l/o 


3t 


S(n+l/n+l)  = S(n+l/n)  + — C(n+l/n+l) 


DR 


3t 


(54) 


(55) 
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This  is  equivalent  to  saying 


Vl  - Cn  + e'DR/t 


t ...  ■ t + a*DR  + t • t in 
n+1  n n+1 


where 


(56) 


a 


/o 


2 

3t 


6/t 


/a 


2 

3t 


It  is  however,  more  convenient  to  use  a and  6/ot  as  smoothing  constants. 
Equations  (56)  and  (57)  then  take  the  form 


(57) 


where 


At 

t 


n+1 


n+1 


a*DR 

• 8 

t + — • At/x 
n a 

t + At  + x • t 
n 


n+1 


a 


jL 

ax 


a 


a 


tt 


n+1 


/o 

/a 


2 

3t 

2 


tt 


n+1 


(58) 


(59) 


The  factor  k determines  the  rate  at  which  past  observations  will 
be  discounted.  It  is  always  slightly  greater  than  one,  but  much  less 
than  two.  In  the  steady  state  condition,  k is  related  to  the  smoothing 
parameters  alpha  and  beta  by 


a 


and 


B/t 


(k  - 1 y 

k2x 


(60) 
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and  of  course 


!_  = (k  - l)2  (61) 

aT  /i  2 , , 

(k  - 1)t 


(Note  that  when  B/t  is  computed  recursively,  as  in  equation  (59), 
frame  time,  t,  is  contained  implicitly  in  the  righthand  term.  How- 
ever, when  the  steady  state  B/t  is  computed,  T is  contained  explicitly.) 

Exactly  the  same  recursion  formulas,  equations  (51)  through  (61), 
apply  to  position  at  an  airborne  unit  in  terms  of  x and  x,  and  y and  y. 
However,  at  a ground  unit  there  is  some  simplification  as  there  is  no 
velocity  term.  In  this  case,  the  recursion  formulas  appear  for  x (or 
y)  as 


C~1(n+l/n+l) 


£ C-1(n/n)  + l/o^ 


(62) 


S(n+l/n+l)  - S(n/n)  + -y-  C (n+l/n+1) *DX  (63) 

°3x 

and  the  effective  smoothing  constants  are  similar  to  equation  (57). 

In  the  steady  state  condition  for  position  adjustment  at  a ground 
unit,  k is  related  to  the  smoothing  parameter  alpha,  by 

a = (k  - 1)  / k (64) 


At  initialization,  and  after  a change  in  task  (unit  type) , values 
of  k and  the  associated  steady  state  alpha  and  beta  will  be  established. 
That  is,  equations  (60)  and  (64)  represent  pre-computed , stored  smooth- 
ing constants. 


The  recursive  operation  of  updating  (C(n/n)  requires  no  matrix 
inversion.  It  proceeds  as  follows,  inserting  the  appropriate  vari- 
ance, a^: 


define  C(n/n) 


a 


b 


b 

c 


(65) 
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f 


t 


then  C(n+l/n+l) 


(66) 


where 


If  solution: 

6 - 1 + k(a  + 2tb  + t2c)/o2 


If  no  solution: 
6=1 


a = k(a  + 2xb  + t^c)/6 


b = k(b  + xc)/6 


» ? 
a = k(a  + 2xb  + t c) 


b = k(b  + xc) 


(67) 


c = k(c  + k{ac  - b2}/a2)/6 


kc 


Then  the  smoothing  constants  become 


’ / 2 

a = a /a 


• 2 

B/t  = b la 


a = (k2  - l)/k2 


6/t  - (k  - l)2/k2x 


(68) 


and  of  course, 


S--b,/a’ 

at 


(69) 


For  a ground  unit,  the  position  covariance  is  updated  simply 


, a3x  * k * ax 


ax  = 


and 


0_  + k • ax 

3x 


ay 


a _ • k • ay 

J*X 1 

a3y  + k * 3y 


(70) 


and  the  smoothing  constants  become 


f 2 1 2 
a = ax  /a.  and  a = ay  /a 
v 3x  y 


3y 


(71) 
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2 2 

The  variances  and  above  refer  to  normal  mode  operation, 
course,  in  the  ranging  m?de  these  would  be  replaced  by  o ^ and  a 


Of 

2 

2y* 


ADJUSTMENT  OF  STATE 

The  adjustments  to  estimates  of  state,  which  is  the  application 
of  equation  (55)  or  (63)  to  obtain  S(n+l/n+l),  will  be  shown  in  detail. 
Determination  of  correction  factors  At,  Ad,  Ax,  Ay,  Ax  and  Ay  during 
the  start-up  process  has  been  indicated  in  equation  (48)  or  (50)  , or 
logical  extension  thereof.  The  remaining  correction  factors  are 

At  = a*DR  - a**TF 

(a*,  the  appropriate  steady  state  smoothing  constant  is  always  applied 
to  feedback) 


Ad  = — • At/x 

a 

(A  reference  site  sets  TF  to  zero) 
Then  for  all  non-master  units, 


t 


n+1 


t + Ad 
n 


n+1 


= t + 
n 


At  + x • t 


n+1 


are  the  updated  estimates  of  system  time. 

Position  adjustment  factors,  presently  computed  for  ground  and  air- 
borne units,  at  end  of  frame,  are 

AX  = -a*DX  + a*  *XF 

AY  = -a*DY  + a*  *YF 

(as  with  time,  the  appropriate  steady  state  smoothing  constant,  a*  is 
always  used  with  feedback) 


(73) 


(74) 
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At  a ground  unit  these  become  directly 
A0  = AY 

AX  = AX 

which  will  be  entered  into  the  position  update  equations. 

At  an  airborne  unit,  which  performs  position  update  every  frame, 
the  factors  at  the  end  of  frame  are 

A0  = Vy*t  + Ay*x  + AY 

AX  = Vx*  t + Ax*t  + AX 

while  at  any  other  time,  they  are  simply 

A0  = Vy*r 

AX  = Vx*r 

Then  both  ground  and  airborne  units  determine  new  positions 

9n+l  ■ K * [40  - ir  • tan  "n]  /R"n 
c n ■* 

(The  terms  in  brackets  appear  in  the  parameter  subroutine 
of  Section  V as 


(75) 


(76) 


(77) 


(78) 


[A0  - AX2*TAN].) 

X = X + AX/ (Nr  .-cos  , . ) 
n+1  n n+1  n+1 

(The  term  Nr  appears  as  1/(A5*A1)  in  the  parameter  subroutine 
of  Section  V.) 

UNCERTAINTY  MATRIX 

After  the  three  2x2  covariance  matrices  Ct,  Cx  and  C have  been 
established  or  updated,  the  output  uncertainty  matrix,  or  C^matrix, 
first  identified  in  equations  (I)  and  (2) , is  computed. 

At  the  master  station,  all  six  elements  are  zero. 
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At  ground  units  in  ranging  mode  and  at  airborne  and  reference 
units,  the  corner  element,  stt  is  just 

stt  = at 

while  at  a ground  unit  in  normal  mode  the  effect  of  position  error  is 
included  by 

2 

stt  = at  4 (sxx*CX2  4-  syyCY2  4 2sxy*cx*cy)/N 

At  a reference  site,  this  is  the  only  element  computed,  all  others 
being  set  to  zero. 

At  ground  and  airborne  units , the  following  relations  correlate 
time  and  position  uncertainty. 

Ranging  mode: 
stx  = 0 

sty  = 0 

Normal  mode,  with  time  solution 
stx  * stt*E2/El 
sty  ■ stt«E3/El 

Normal  mode,  without  time  solution 
stx  = k^*stx 
sty  = k^*sty 

where  the  appropriate  (ground  or  airborne)  value 
of  k^  is  used. 

The  diagonal  elements,  sxx  and  syy  for  a ground  unit  are  the  cor- 
ner elements  of  C and  C . That  is: 
x y 

sxx  = ax 

(ground) 

syy  = ay 


(80) 


(81) 


(82) 


(83) 


(84) 


(85) 
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While  for  airborne  units , they  are 

2 

sxx  = (stx)  /at  + ax 

2 (86) 

syy  = (sty)  /at  + ay 

For  an  airborne  unit  in  ranging  mode,  the  above  reduces  to  equation 
(85)  since  stx  and  sty  are  zero.  In  normal  mode,  however,  the  time 
dependence  of  the  position  determination  is  illustrated. 

The  remaining  term,  sxy,  correlating  the  x and  y position  uncer- 
tainty, has  four  possible  forms: 

No  solution 

sxy  = l^'sxy  (87) 

Solution  obtained,  ranging  mode 

sxy  = -kp2*cxy/El  (88) 

Solution  obtained,  normal  mode 

sxy  = kp-*X3/V  (ground) 

(89) 

sxy  = stx*sty/at  - kp2*cxy/El  (airborne) 

where  again,  the  appropriate  parameters  k£  and 
kp2  are  entered  into  equations  (87)  to  (89) 

The  diagonal  elements  stt,  sxx  and  syy,  it  can  be  seen,  are  ob- 
tained directly  from  the  updating  process  for  the  three  separate 
2x2  covariance  matrices.  This  process  considers  whether  or  not  a 
solution  has  occurred  and  the  relationship  of  the  solution  variance 
to  the  current  or  tracked  variance.  Compromise  with  convenience, 
however,  has  been  utilized  in  determining  the  cross  terms,  or  off- 
diagonal  elements.  In  this  case,  if  a solution  occurs,  the  uncer- 
tainty is  taken  to  be  the  steady  state  reduction  of  variance  (a  func- 
tion of  the  discount  factor  k(kt  or  kp))  times  the  solution  variance. 

While  if  no  solution  occurs , the  uncertainty  from  the  previous  frame 
is  increased  by  the  discount  factor  k. 
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SECTION  III 


INTERRUPTS 


GENERAL 


Once  the  start  action  has  been  taken  by  the  operator,  the  se- 
quencing of  the  program  is  under  the  control  of  interrupts.  External 
interrupts  initiate  the  processing  of  received  messages,  and  internal 
interrupts  (controlled  by  computer  clock)  initiate  end  of  frame  pro- 
cessing and  transfer  messages  to  the  radio  for  transmission.  The 
following  paragraphs  provide  a brief  sketch  of  these  operations. 


PROGRAM  START 

Program  start  is  divided  into  two  phases  — Data  Entry  and  Ini- 
tialization. During  the  data  entry  phase,  the  program  is  running, 
but  not  cycling  in  the  sense  of  position  and  time  extrapolation. 

Data  is  entered  and  response  to  certain  commands  is  permitted.  Under 
normal  circumstances  the  minimum  read-in  set  consists  of  unit  ID, 
slot  assignment (s) , position  (known  or  initial  assumption),  velocity 
(airborne  units) , unit  task  designation  and  mode  of  operation. 

The  initialization  phase  is  begun  by  operator  action.  The 
action  causes  the  initialization  routine  to  be  entered,  which  deter- 
mines constants  and  starts  cycling  and  extrapolation.  The  computer 
clock  is  read  and  the  time  for  the  first  end  of  frame  processing 
interrupt  is  determined.  At  the  MASTER  unit  this  leads  to  the  first 
position  report  transmission.  At  the  other  units  this  begins  the 
listening  process. 


MESSAGE  RECEIVED  INTERRUPT 

The  message  received  interrupt  initiates  a two-stage  process. 
The  first  stage  is  essentially  a housekeeping  process,  kept  delib- 
erately as  short  as  possible,  which  accomplishes  little  more  than 
picking  up  and  stacking  the  message  for  further  processing.  The 
second  stage  is  a filtering  and  an  information  extraction  process. 
In  this  paper,  only  those  parts  of  the  process  that  pertain  to  the 
requirements  for  recursive  navigation  will  be  addressed  in  detail. 
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Whatever  routine  is  in  process  when  a message  received  inter- 
rupt occurs,  operation  of  that  routine  is  temporarily  suspended  while 
the  first  stage,  message  preprocessing,  is  accomplished.  Operation 
is  then  resumed  on  the  interrupted  routine.  It  is  conceivable  that 
with  certain  long  routines,  more  than  one  interrupt  could  occur,  thus 
building  up  a backlog  of  messages  stacked  for  future  processing. 

When  operation  of  the  interrupted  routine  is  finally  concluded,  and 
any  other  priorities  satisfied,  the  second  stage  of  the  message  pro- 
cessing is  begun.  This  is  the  filtering  and  information  extraction 
process,  which  may,  in  turn,  be  temporarily  suspended  by  other 
interrupts. 


TIME  TO  TRANSMIT  INTERRUPT 

Whatever  routine  or  subroutine  is  in  process,  when  a time  to 
transmit  interrupt  occurs,  operation  of  that  routine  is  temporarily 
suspended  while  a previously  constructed  message  is  conveyed  to  the 
transmitter  for  transmission  at  a predetermined  time.  Operation  of 
the  interrupted  routine  is  then  resumed. 

The  time  to  transmit  interrupt  is  associated  with  a reading  on 
the  computer  clock.  The  actual  time  to  transmit  is  associated  with 
a reading  on  the  radio  clock. 

Proper  management  and  control  functions  must  be  accomplished  so 
that  transmit  and  receive  operations  will  not  conflict. 


TIME  TO  BEGIN  END  OF  FRAME  PROCESSING  INTERRUPT 

The  time  to  begin  end  of  frame  processing  interrupt  is  associ- 
ated with  a reading  on  the  computer  clock.  It  is  set  to  occur  so  as 
to  provide  adequate  time  for  end  of  frame  processing  prior  to  the 
transmission  of  the  periodic  position  report.  This  will  not  inter- 
rupt routines  entered  due  to  message  received  or  time  to  transmit 
interrupt,  but  will  allow  them  to  be  completed.  It  will,  however, 
prevent  any  further  second  stage  message  processing  until  after  com- 
pletion of  the  end  of  frame  processing. 

The  time  for  this  interrupt  is  adjusted  each  frame  (if  messages 
were  received  or  transmitted)  to  keep  the  radio  clock  and  computer 
clock  in  rough  synchronization. 
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SECTION  IV 


ROUTINES 


DISCUSSION 

There  are  three  major  routines  that  are  entered  in  response  to 
external  or  internal  interrupts.  These  are  the  initialization,  mes- 
sage processing,  and  end  of  frame  processing  routines.  In  addition 
to  accomplishing  the  recursive  navigation  functions  of  position 
location  and  time  synchronization,  these  routines  maintain  control 
of  the  program  by  setting  and  resetting  counters , indices  and  future 
interrupts.  Additionally,  there  is  an  enter  data  phase.  This  phase 
occurs  prior  to  the  start  of  the  recursive  position  location  and  time 
synchronization  functions. 

The  computational  burden  of  the  least  squares  linear  unbiased 
estimate  of  time  and  position  error  is  distributed  between  the  mes- 
sage processing  routine  and  the  end  of  frame  processing  routine. 

The  former  determines  the  measurement,  computes  weighting  factors 
and  maintains  running  sums.  The  latter  utilizes  the  sums  to  estimate 
time  and  position  errors;  these  estimates  in  turn  are  entered  into 
difference  equations  (smoothing  equations)  to  arrive  at  adjustments 
to  be  made  to  current  estimates  of  time,  position  (and  velocity), 
followed  by  a position  extrapolation. 

The  logical  design  of  these  routines  is  presented  in  the  fol- 
lowing pages.  To  make  the  logic  flow  as  compact  as  possible,  cer- 
tain parts  of  these  routines  have  been  separated  out  as  subroutines. 
The  section  on  subroutines  follows  this  section,  which  in  turn  is 
followed  by  a complete  alphabetic  parameter  listing. 


ENTER  DATA  (PHASE) 

This  is  not  a routine,  but  a necessary  phase  of  the  start-up 
process.  The  computer  program  is,  of  course,  running  in  the  sense  of 
responding  to  commands  (interrupts)  and  looking  for  things  to  do. 

But  the  navigation  and  timing  functions  of  position  extrapolation 
and  synchronization  have  not  yet  begun.  Before  the  start  action  is 
taken,  certain  switch  settings  must  be  accomplished  and  parameter 
values  entered. 
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1.  The  usual  read-in  sets  consist  of, 

0o  latitude  in  minutes  north  of  0r 

Xo  longitude  in  minutes  west  of  Xr 

Zo  altitude  in  feet  above  sea  level 

AIRBORNE:  initial  velocity  estimate 

Vo  speed  in  knots 

Ho  heading  in  degrees  from  true  north 

Unit  identification,  ID 

Slot  assignment,  Sa,  for  the  periodic  position  report. 

The  above  seven  parameters  are  programmed  zero.  Some,  if  not 
entered  will  be  estimated  by  the  program;  others,  remaining  zero 
will  prevent  the  start-up  process. 

Unit  identification  must  be  entered  at  all  units  before  start-up 

Initial  position  must  be  entered  at  MASTER  or  REFERENCE  sites 
prior  to  start-up. 

Any  non-MASTER  unit  not  entering  slot  assignment,  Sa,  is  forced 
to  remain  in  the  QUIET  mode.  (The  assignment  may  be  received  by  mes 
sage  interpretation.) 

At  a GROUND  or  AIRBORNE  unit  initial  position,  velocity  and  wind 
data  (as  applicable)  may  be  entered  before  start-up.  The  values 
entered  being  the  best  estimate  of  conditions  at  the  time  the  start 
action  is  taken.  If  not  entered,  0c,  Xc,  Zc  (ground)  or  0c,  Xc,  Za 
(airborne)  is  supplied  by  the  program.  And,  if  velocity  and  winds 
are  not  supplied,  the  program  starts  with  estimates  set  to  zero. 


2.  Switch  settings 


Unit  Task  Designation 


MASTER 

REFERENCE 

GROUND 

AIRBORNE 


Mode  of  Operation 


UNSPECIFIED 

RANGING 

NORMAL 

QUIET 
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The  mode  of  operation  will  usually  be  left  on  UNSPECIFIED.  Unit 
designation  must  be  made  before  start-up.  It  may  be  changed  during 
operation,  manually,  in  which  case,  the  program  will  re-enter  the 
initialization  routine. 


3.  Any  additional  parameters,  as  desired,  may  be  read  in,  provided 
coordination  among  all  units  is  accomplished. 


INITIALIZATION  (ROUTINE) 

The  initialization  routine  has  two  entry  points.  When  the  oper- 
ator initiates  the  start  action,  the  routine  is  entered  at  point  1. 
Initial  parameter  values  are  computed  and  the  process  of  cycling  and 
position  extrapolation  is  begun.  (Item  3.  actually  represents  pre- 
computed and  stored  program  constants.)  The  routine  is  also  entered 
when  message  processing  or  data  entry  causes  a change  in  unit  desig- 
nation. In  this  case,  the  routine  is  entered  at  point  10.  and  the 
appropriate  adjustments  made. 

When  data  entry  is  complete,  the  start  action  initiates  the 
cycling  process.  The  initialization  routine  proceeds  as  follows: 

1.  Test  identification  entry. 

If  ID  = 0 (no  entry),  hold  up  start  action,  alert  operator. 

If  ID  has  been  entered,  proceed. 

2.  AIRBORNE:  Read  computer  clock, 

set  to  = computer  clock  reading. 

3.  Fixed  constants. 


a = SMA 

convert  units 

A1  = 1/a 

inverse 

f = 1/FLAT 

flattening 

e = f(2  - f) 

eccentricity  squared 

A2  = a(l  - e) 

A3  = l/(a  • /l  - e) 
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Set  0 = (0c  + 0r)  sector  center  latitude 

Get  parameters  (subroutine) 

DTERM  = 3 • e • Rm  • sin  0 • cos  0/2A4 

Nc  = a/A5  mean  normal  radius 

Cl  = c /INDEX 

Clinv  = 1/Cl 

4.  Test  position  entry. 

MASTER  or  REFERENCE: 

If  no  position  entry,  hold  up  start  action, 
alert  operator. 

If  position  available,  proceed,  (i.e.,  0o  + Xo  + Zo  ^ 0). 
GROUND  or  AIRBORNE: 

If  no  initial  position  is  given,  set 
0o  = 0c 
Xo  = Xc 

GROUND:  Zo  = Zc 

AIRBORNE:  Zo  = Za 

If  initial  position  available,  proceed. 

5.  Set  initial  position. 

0 = 0o  + 0r 

X = Xo  + Xr 
Z = Zo 

NON-AIRBORNE : set  updated  position 

0'  - 0 
i 

X = X 
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6.  Initial  clock  parameter  values 

t =1  (if  master  establishing  one  second  frame) 
t = .993  (If  master  synchronizing  to  east  coast  Loran  chain) 
T2  = x • t frame  duration 

T1  = T2///  slot  duration 

Get  parameters  (subroutine) 

7.  AIRBORNE:  Set  velocity 

If  Vi  = 0 (unavailable) , set  V = Vo  (manual  input) 

If  Vi  / 0 (available) # set  V ° Vi  (instrument  input) 

Then  Va  = V assumed  velocity 

If  Hi  < 0 (unavailable) , set  H = Ho  (manual  input) 

If  Hi  >_  0 (available)  , set  H = Hi  (instrument  input) 

Then  Ha  = H assumed  heading 

Check  for  manual  entry  of  wind  data,  Vw  and  Hw  (wind  speed 
and  direction  from)  and  convert  to  wind  estimate  components 

Wx  = Vwsin  Hw 

Wy  = -Vwcos  Hw 

Then  the  x,  y velocity  components  are  computed 
Vx  = Wx  - V*sin  H speed  west 

Vy  = Wy  + V*cos  H speed  north 

compute  angular  values 
V0  = Vy/Rm 
VX  = Vx*Al*A5/cos0 
8a.  GROUND:  zero  velocity 

Vx  = Vy  = 0 
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8b. 


ALL  Units: 


Set  State  = UU 
Operating  Mode  = QUIET 
9.  Read  computer  clock 

Set  tc  = current  computer  clock  reading 

S = 0 dummy  slot  assignment 

t = 0 dummy  transmit  time 

Set  end  of  frame  interrupt  time 
Teoc  = tc  - 6p  + T2 

Compute  value  of,  but  do  not  set,  transmission  interrupt  time 
Tip  = tc  - 6B 
AIRBORNE : extrapolate 

txp  = tc  - to  time  interval  from 

start  action 

0 = 0 + V0  • txp  latitude 

X = X + VX  • txp  longitude 

10.  Set  operating  mode,  status,  smoothing  constants  and  task 
sensitive  constants. 


kpl 

kp2 

kp3 


time  discount  factor 
x-pos  " 11 

y-pos  " 11 

steady  state  a 


x 


AIR 

GROUND 

kta 

ktg 

kpa 

kpg 

kpa 

kpg 

ktal 

ktgl 

kpal 

kpgl 

kpal 

kpgl 

REF 

MASTER 

ktr 

ktl 

kpg 

kpg 

kpg 

kpg 

ktrl 

ktll 

kpgl 

kpgl 

kpgl 

kpgl 

it 


tt 
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AIR 


GROUND 


MASTER 


REF 


kVi 

steady  state  S/at 

kda 

kdg 

kdr 

kdl 

CM 

" " S/a 

X 

kva 

0 

0 

0 

kv^ 

" " S/ay 

kva 

0 

0 

0 

CTS 

frames  to  Sync 

CTSG 

CTSG 

CTSR 

CTSR 

CTU 

frames  to  Unsync 

CTUG 

CTUG 

CTUR 

CTUR 

state 

_P 

SP 

operating  mode 

NORMAL 

MIS 

(external)  master-in-sight  0 
indicators 

0 

1 

1 

MIS 

(internal) 

0 

0 

0 

0 

RIS 

(internal)  ref-in-sight 

0 

0 

0 

0 

indicator 


11.  Set  Counters 
CP,  CT  * 0 

12.  Zero  sample  counts  and  feedback 

NS,  N,  NT,  NSP,  NSU,  NUP,  TF,  XF,  YF  = 0 

13.  Zero  running  sums 

d,  dx,  dy,  dt,  cx,  cy,  cxy,  CX2,  CY2  = 0 

14.  Clock  advance 

IND  = 0 (off)  in  data  indicator 

AC  = 0 change  in  clock  advance 

MESSAGE  PROCESSING 

Message  processing  is  a two  stage  process  initiated  by  a message 
received  interrupt.  The  first  stage  — preprocessing  — is  essentially 
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a housekeeping  process,  kept  deliberately  as  short  as  possible.  The 
second  stage  — processing  — is  a filtering  and  information  extrac- 
tion process , which  may  be  long  or  short , and  which  may  cause  future 
actions  to  take  place.  Those  portions  of  the  message  processing 
routines  which  are  required  to  support  recursive  navigation  are  dis- 
cussed in  the  following  sections. 

Preprocessing 

The  preprocessing  routine  is  structured  so  that  on  each  message 
received  or  message  transmitted  interrupt,  a correspondence  between 
the  radio  clock  reading  and  the  computer  clock  reading  can  be 
established. 

Upon  receipt  of  message  received  or  message  transmitted  interrupt: 
Set  trad  = tj 

where  tj  is  the  clock  reading  inserted  into  the  received 
message  by  the  receiver,  or  the  transmit  time  requested 
for  the  transmitted  message. 

Cause  the  computer  clock  to  be  read,  and  stored. 

Set  tcomp  = tc 

where  tc  is  the  current  computer  clock  reading  (in  com- 
puter clock  units) 

Set  IND  = 1 

Every  message  is  saved,  or  stacked,  for  future  processing. 

Processing 

Message  processing  is  a combination  filtering  and  action/no-action 
process.  Many  tests  may  be  performed  on  the  message  before  deciding 
what  to  do  with  it. 

1.  Compute  time  in  transit.  (all  messages) 

modulo  // 

Ts  = [tj  - {t  + T1  (Sj  - S) } ] - 6 time  in  transit 

\ 

modulo  t 
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where  t and  S are  the  time  and  slot  number  of  the  local  unit’s  last 
position  report,  and  tj  and  Sj  are  the  arrival  time  and  slot  number 
of  the  current  message  being  processed.  T1  is  local  slot  duration 
and  6 accounts  for  internal  delays.  If  the  message  has  been  held  in 
stack  during  end  of  cycle  processing  it  is  necessary  to  account  for 
any  change  in  time  rate  estimate  by  setting 

Ts  = Ts  + T2 


2.  Justify.  The  transit  time,  Ts,  must  be  kept  in  the  range 
-0.005  Ts  < 0.995  seconds. 

If  Ts  < -0.005  seconds. 

Set  Ts  = Ts  + 1.0  seconds. 

If  TS  >_  0.995  seconds, 

Set  Ts  = Ts  - 1.0  seconds. 


3.  Position  Report:  if  so  labeled,  a message  containing  the  posi- 
tion Pj  = (0j , X j , Zj),  which  arrived  at  radio  time  tj  in  time  slot 
Sj  is  to  be  processed. 

a.  Enter  data  into  the  Data  Source  Table,  indexed  by  unit  ID: 


IDj 

tj,  Sj 

state_j , task_J 
Xj,  Zj 
Vj,  Hj 


identity 

arrival  time,  slot  number 
state,  task  designation 
position 
velocity 


stt j , stxj , styj  uncertainty  matrix 

sxxj,  sxyj , syyj 

b.  If  Task_j  is  MASTER,  set  MIS  = 1 (on)  master  in  sight. 

If  TaskJ  is  REFERENCE,  set  RIS  = 1 (on)  reference  in  sight. 
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c.  REFERENCE: 


If  Task_J  is  not  MASTER,  and  if  MIS  ■ 1,  then  exit. 

If  Taskj  is  GROUND  or  AIRBORNE,  and  if  RIS  = 1,  then  exit. 

d.  Check  source  state 

If  state_j  is  UU,  exit  to  main  program 
If  state_j  is  UP, 

set  NUP  = NUP  +1,  then  exit  to  main  program 
If  state_j  is  SU 

set  NSU  = NSU  + 1 

If  CT  ^ 0,  or  if  local  unit  is  MASTER,  exit  to  main  program 
If  state_j  is  SP, 

Test  received  MIS  indicator 
If  MIS_j  = 0,  exit  to  main  program. 

NSP  = NSP  + 1 

If  NSP  £ 3,  store  IDj  in  SIDj  (indexed  by  NSP) 

e.  If  operating  mode  ranging,  skip  to  item  j. 

f.  AIRBORNE:  update  position. 

txp  = tj  - t modulo  x extrapolation  interval 

If  txp  > (x  - 6p) , set  txp  = txp  - t 

i 

0 = 0 + V0  • txp 

t 

X = X + VX  • txp 

g.  Use  geometry  subroutine  to  find  computed  range,  Rc,  and  direc- 
tion cosines,  SIN  V and  COS  f.  Upon  return  from  geometry, 
enter  Rcj  into  the  data  source  library. 
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h.  The  measured  range  is 
Rt  = vp  • Ts 

(the  value  of  vp  depends  upon  whether  Loran  data  or  UHF 
data  is  being  processed) 

i.  Proceed  to  Summation  subroutine. 

j.  Feedback:  If  this  is  a position  report  from  the  Master 

it  contains  the  time  and  position  feedback  adjustments. 

a.  NON-MASTER:  set 

TF  = TFj 

XF  = XFj 

YF  - YFj 

(where  the  j indicates  data  in  the  message  to  be  stored.) 

4.  Ranging  Reply  addressed  to  local  unit:  if  so  labeled  and  addressed, 

a message  containing  the  position  Pj  = (0j , X j , Zj),  and  the  apparent 
one  way  transmission  time,  Tsr,  as  measured  by  the  responder,  which 
arrived  at  time  tr  in  slot  Sr,  in  response  to  interrogation,  is  to  be 
processed.  The  position,  Pj , represents  the  mean  position  over  the 
interrogation  interval.  While  the  quantities  tr  and  Sr  represent  the 
same  physical  data  as  would  tj  and  Sj  when  processing  a position 
report,  the  distinction  is  made  to  avoid  confusion  when  both  tr  and 
tj  must  be  used,  in  which  case,  tr  refers  to  the  current  reply  mes- 
sage in  process,  and  tj  refers  to  the  last  position  report  received 
from  the  same  unit. 


If  any  one,  of  | TF | > DM4,  or 
|XF|  > 1/2  n.m.  , or  |yf|  > 1/2 
n.m.  set  all,  TF  = XF  = YF  = 0. 


a.  Compute  the  factor 

tq  = (tr  - ti)/2,  subtraction  modulo  t 
(where  ti  was  the  time  of  interrogation) 

b.  AIRBORNE:  extrapolate  position 

. modulo  # 

txp  = tq  + T1  (si  - S) 

f 

0 = 0 + V0  • txp 
X = X + VX  • txp 
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(in  the  previous,  ti  and  Si  are  the  time  and  slot  number 
of  the  interrogation  sent  out  by  local  unit.  They  are 
in  the  interrogation  table) . 

c.  Use  geometry  subroutine  to  find  computed  range,  Rc,  and 
direction  cosines  SIN  Y and  COS  Y.  Upon  return  from 
geometry,  store  Rcj  in  data  source  library. 

d.  The  measured  range  is 

Rt  = vp  (Tsr  + Ts)/2  measured  range 

e.  If  reply  synchronized  (time  state  S) ; compute 

Tsr  + Ts 

T ■ one  way  time 

If  either  source  or  receiver  is  AIRBORNE,  compute  modi- 
fication to  time  measurement  to  account  for  relative 
velocity: 

t'  - t'  + [(Vx  + Vj  *sinHj)SINY  - (Vy  - Vj*cosHj)  COSY] 

Vj 


where  Vj  and  Hj  come  from  the  data  source  library. 

t 

dt  = dt  + Ts  - T 
NT  = NT  + 1 

f .  If  reply  position  state j is  P (known) , then 

proceed  to  summation  subroutine.  Then  exit. 

Otherwise,  exit. 

5.  Ranging  Interrogation  addressed  to  local  unit:  if  so  labeled  and 

addressed,  a request  for  a timing  measurement  and  a reply  has  been 
received  at  time  tj  in  slot  Sj.  The  request  asks  for  a reply  in  slot 
Sr  to  unit  IDj , containing  the  time  measurement  Tsr  and  the  mean  posi- 
tion over  the  interrogation  interval. 
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a.  The  transmission  time,  on  radio  clock,  is 
tr  = t + Tl[ (Sr  - Sj)  + (Sj  - S) ] 

r \ / 

modulo  t modulo  # 

(where  t and  S refer  to  time  and  slot  number  of  local 
unit's  last  position  report,  tj  and  Sj  the  arrival 
time  and  slot  of  the  current  message — the  interroga- 
tion, and  Sr  the  requested  reply  slot.) 

b.  AIRBORNE:  determine  position  for  transmission 

txp  = (tj  - t)  + (tr  - tj)/2 
modulo  T 
0t  = 0t  + V0  • txp 
Xt  = Xt  + VX  • txp 

c.  Prepare  message  for  transmission  at  time  tr,  which  is 
the  start  of  slot  Sr,  as  per  request,  containing  Tsr, 
which  is  the  Ts  just  measured,  0t,  Xt,  Z,  and  current 
state,  as  well  as  own  (sender)  ID,  slot  number  Sr, 
message  type,  and  the  addressee  identification  IDr. 

Set  time  to  transmit  interrupt  on  the  computer  clock  to 

Trr  = Tip  + Tl((Sr  - Sj)  + (Sj  - S) ) 

\ / 
tuodulo  // 

d . Exit . 


END  OF  FRAME  PROCESSING  (ROUTINE) 

The  end  of  frame  processing  routine  is  entered  once  per  frame  in 
response  to  a timed  interrupt.  The  time  for  this  interrupt — the  time 
to  begin  end  of  frame  processing — is  computed  or  adjusted  at  least 
once  per  frame  to  assure  that  the  processing  is  completed  prior  to 
the  time  for  the  position  report  transmission.  This  routine  operates 
on  data  gathered  during  the  frame  to  determine  adjustments  to  esti- 
mates in  timing,  position  and  velocity;  to  consider  changes  in  data 
status  or  mode  of  operation;  and  to  reset  certain  parameters  for 
another  frame  of  operation. 
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0.  Internal  Synchronization 

If  IND  = 1,  compute  change  in  clock  advance, 

^modulo  x modulo  t 

AC  * [tcomp  - (Tip  + B)]  - (trad  - t) 

If  AC  < -0.02  seconds,  set  AC  * AC  + 1.0  seconds 

If  AC  >_  +0.98  seconds,  set  AC  = AC  - 1.0  seconds. 

If  now,  AC  > 0.5,  set  t = t + T2 

Set  IND  - 0 

0a.  Compute  mean  range  error 
MRE  = d*  Clinv/N 

1.  MASTER:  compute  feedback 

Set  TF  = XF  = YF  = 0 zero  out  feedback 

If  N >_  2,  compute  feedback 

TF  = ktm  • d • Clinv/N,  limiting  |tf|  DM4 

Get  position  adjustment  (2x2)  (subroutine) 

XF  = kpm  • DX,  limiting  | XF | <_ 1/2  n.m. 

YF  = kpm  • DY,  limiting  |yf|  1/2  n.m. 

t = t + T2  transmit  time 

(If  the  master  unit  is  synchronizing  to  the  Loran  net,  then 
it  will  proceed  with  that  Loran  data,  much  as  a reference 
unit  with  items  2. , 3. , 6. , and  10.  The  details  will  be 
omitted. ) 

Then  skip  to  item  12. 
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2.  Set  At  and  Ad  = 0. 


Set  TN  and  PN  = 0. 

If  CT  = 0,  1 or  2;  or  if  CT  < -CTU,  then  proceed  with  Gross 
Sync  Phase: 

If  n M)  compute 

At  = MRE 
TN  = 1 

Restore  clock  rate  (T2) 

Set  items  SM(t)  and  TI(t)  to  zero,  and 
Advance  Time  Phase  to  Start. 

Skip  to  item  6,  to  compute  times. 

3.  REFERENCE:  Compute  time  estimate  adjustments 

Set  PN  = 1 position  known 

Set  DR,  Ds,  aSQ^  = 0 zero  parameters 

Set  i = 1 (reset  index  for  system  time) 

If  operating  mode  is  RANGING,  then 


If  NT  ^ 0,  set 


TN  =1 
DR  = dt/NT 
aSQ1  = 1/2NT 


time  adjustment  computed 
time  error  estimate 
solution  variance 


If  operating  mode  is  NORMAL  or  QUIET,  then 


If  SYNC  MODE  is  TOA,  and  if  N t 0,  then 


TN  =1 
DR  = MRE 
aSQ1  = 1/N 


time  adjustment  computed 
time  error  estimate 
solution  variance 


If  time  state  = S,  test  magnitude  of  DR 

If  |dr|  > DM5,  set  TN  = 0,  MIS  = 0 (external  only) 
If  | DR | > DM4,  limit  magnitude  of  DR  to  DM4 
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If  phase  2 (start  up — system  clock) , then 

Set  Ds  = DR»C1 

Call  Start  (subroutine) 

If  As  is  non-zero,  set 

At  = As*Clinv 
Ad  = A§*Clinv 
stt  = a^ 

Skip  to  item  6.  (to  compute  times) 
If  phase  3 (recursive) , then 
Call  Update  (subroutine) 


range  error  estimate 


system  time  adjustment 

" " rate  adjustment 

time  uncertainty 


At 

stt 


ai‘DR 
a 


system  time  adjustment 
time  uncertainty 


Skip  to  item  6.  (to  compute  time  and  time  rates) 

(Note:  at  a reference  site,  uncertainty  factors  stx,  sty,  sxx,  sxy, 

and  syy  are  always  zero.) 


4.  AIRBORNE:  set  Ax,  Ay  = 0. 

5.  GROUND  or  AIRBORNE:  set  AX,  AY  = 0. 

Set  DR,  DX,  DY,  oSQ^,  crSt^ , oSQ^,  ■ 0 
If  state  not  SP,  then  set  TF,  XF,  YF  ■ 
If  operating  mode  RANGING,  and 

If  NT  ^ 0,  then  set 


zero  velocity  adjustment 
zero  position  adjustment 
zero  parameters 
zero  feedback. 


TN 

DR 

OSQ. 


1 

dt/NT 

1/2NT 


If  NS  >_  2,  then  set  PN  - 1 


time  adjustment  computed 
time  error  estimate 
solution  variance 

position  adjustment 
computed 


If  NS  < 2,  and  if  GROUND  unit  with  position  state  P,  then 
Set  PN  = 1 assume  position  O.K. 

Skip  to  5b.  (to  limit  DR  and  obtain  time  adjustment). 
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If  operating  mode  NORMAL  or  QUIET,  and 


If  NS  < 3,  and  if  GROUND  unit  with  position  state  P,  then 


Set  PN  = 1 

assume  position  O.K. 

If  N + 0,  set 


TN  =1 
DR  = MRE 

crSQj^  = 1/N 

adjustment  computed 
time  error  estimate 
solution  variance 

Skip  to  5a. 

If  NS  - 2,  and  if  AIRBORNE  unit,  then 


If  time  state  S, 

Set  PN  = 1 

adjustment  (to  be) 
computed 

Skip  to  5b. 


If  NS  ^ 3,  then 

Set  TN  and  PN  = 1 

position  and  time  ad 
justments  computed 

Get  position  and  time  adjustment  (3  x 3) 

If  GROUND  unit  with  position  state  P,  then  set 


DR  = MRE 
aSQi  = 1/N 
TN  =1 
Skip  to  5a. 

time  error  estimate 
solution  variance 
adjustment  computed 

If  TN  = 0 (no  solution) , skip  to  5b 


aSQ1  = El/V 

solution  variance 

5a.  If  state  SP,  and  if  MIS  = 1,  then 

GROUND:  set  SIGN  = +1 
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AIRBORNE : 


If  MRE  > MQ1,  and  DR  < -MQ2 , or 
MRE  < -MQ1,  and  DR  > MQ2,  then 

SIGN  = -1  significant  disagreement 

Else  SIGN  = +1 

Both  GROUND  and  AIRBORNE: 

If  TF  > MQ2 , and  DR  > 0 , then 

If  SIGN  - -1,  set  DR  = MRE 
Else  set  DR  = 0 

If  TF  < -MQ2 , and  DR  < 0,  then 

If  SIGN  = -1,  set  DR  = MRE 
Else  set  DR  = 0 

5b.  Test  and  Limit  Magnitudes 

If  time  state  S,  then 

If  |MRE|  > DM5,  then 

Set  TN  and  MIS  = 0. 

Limit  the  magnitude  of  DR  to  DM4 

Set  Index  i = 1. 

If  phase  2 (start  up — system  time) , then 

Set  Ds  = DR*C1 

Call  Start  (subroutine) 

If  As  is  non-zero,  set 

At  = As*Clinv 
Ad  = As*Clinv 
stt  = a^ 

Skip  to  5c. 
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If  phase  3 (recursive — system  time) , then 

Call  Update  (subroutine) 

At  = a^*DR  - kp^*TF 

If  operating  mode  is 

stx,  sty  = 0 

If  aSQ^  = 0,  then 

stx  = k^*stx 

sty  = k^*sty 

time  factor  x = 

time  factor  y = 

time  factor  xy  = 

AIRBORNE  units: 

stt  = a^ 

If  aSQ^  f 0,  then 

stx  = stt*E2/El 
sty  = stt*E3/El 

If  operating  mode  ^ Ranging,  then 

2 2 

time  factor  x = a^*E2  /El 

2 2 

time  factor  y - a^‘E3  /El 

o 

time  factor  xy  = a^*E2*E3/El 

If  operating  mode  = Ranging,  then 

time  factor  x = 0 
time  factor  y = 0 
time  factor  xy  **  0 

Skip  to  5d. 


Ranging,  then 


k^'time  factor  x 
k^time  factor  y 
k^*time  factor  xy 
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GROUND  units: 


stt  = + pos  factor 

stx  = stt* pos  factor  x 
sty  = stt*pos  factor  y 
time  factor  x = 0 
time  factor  y ■ 0 
time  factor  xy  = 0 

5c.  Independent  or  Hyperbolic  position  solution. 

(Used  by  GROUND  units,  any  state,  and  by  AIRBORNE  units 
with  time  state  U.) 

If  PN  + 0,  and  NS  >_  3,  then 

aSQ2  = X2/V  solution  variance,  x 

aSQ^  = Y3/V  solution  variance,  y 

Skip  to  5e. 

5d.  Dependent  or  Direct  Ranging  position  solution. 

(Used  by  any  unit  in  ranging  mode,  and  by  AIRBORNE  units  with 
time  state  S in  NORMAL  or  QUIET.) 

If  NS  ^ 2,  then 

Get  position  adjustment  (2  x 2)  (subroutine) 


If  PN  j*  0,  then 

aSQ2  = CY2/E1  solution  variance,  x 

aSQ^  = CX2/E1  solution  variance,  y 

5e.  Limit  position  adjustments 
If  position  state  U,  then 

Limit  the  magnitudes  of  DX  and  DY  to  30  n.m. 

If  position  state  P,  then 

Limit  the  magnitudes  of  DX  and  DY  to  QMAX. 
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5f.  Set  Index  i = 2. 


If  Phase  2 (start  up — position) , then 

Set  Ds  = -DX 

Call  Start  (subroutine) 

If  As  is  non-zero,  set 

Ax  = As 
Ax  = A§ 
sxx  = a^ 

Set  Index  i = 3 


Set  Ds  = -DY 

Call  Start  (subroutine) 

If  As  is  non-zero,  set 

Ay  As 
Ay  = As 
syy  = a± 

stx,  sty,  sxy  = 0 
Skip  to  item  6. 

If  phase  3 (recursive — position) 

AIRBORNE  units: 

Call  Update  (subroutine) 
sxx  = a^  + time  factor  x 

Set  Index  i = 3 

Call  Update  (subroutine) 

syy  = a^  + time  factor  y 

If  operating  mode  NORMAL  or  QUIET,  and  if  PN  = 1,  set 
sxy  = time  factor  xy  - kp^'cxy/El 
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GROUND  units: 


Call  Update  Ground  (subroutine) 
sxx  = a^  + time  factor  x 

Set  Index  i = 3 

Call  Update  Ground  (subroutine) 
syy  = a^  + time  factor  y 

If  operating  mode  NORMAL  or  QUIET,  and  if  oSQ^  ^ 0,  then 
sxy  = kp2  X3/V 

pos  factor  = (a2*CX2  + a3*CY2  + 2*sxy*cx*cy)/N^ 
pos  factor  x = E2/E1 
pos  factor  y = E3/E1 

If  operating  mode  Ranging,  then 

pos  factor  = 0 
pos  factor  x ■ 0 
pos  factor  y = 0 

Both  AIRBORNE  and  GROUND  units: 

AX  = -o^'DX  + kp2*XF  position  adjustment,  x 

AY  = -ag’DY  + kp2*YF  position  adjustment,  y 

If  0SQ2  ^0,  and 

If  operating  mode  Ranging,  then 
sxy  = -kp2*cxy/El 
If  oSQ2  = 0,  then  sxy  = k2*sxy 
6.  Adjust  estimates  of  time  rates 

NON-MASTER:  If  phase  3 (recursive — system  time) , then 

Ad  = B^At/r 
limit  | Ad  | £ DMAX 
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6a.  All  phases: 


system  time  rate 
nominal  frame  time 


t = t + Ad 
T2  = x • t 

T1  ■ T2 /#  slot  duration 

xf  = T2  + At  frame  extrapolation 

t = t + xf  position  report  trans- 

mit time 

7.  AIRBORNE:  compute  extrapolation  velocity  and  adjust  velocity 

factors. 

Ax  = $2*Ax/t^ 

limiting  the  magnitude  of  Ax  to  VMAX 
Ay  = 6g*Ay/xf 

limiting  the  magnitude  of  Ay  to  VMAX 

Wx  = Wx  + Ax  updated  wind  estimate,  west 

Wy  = Wy  + Ay  updated  wind  estimate,  north 

If  air  data  inputs  available,  get  new  speed  and  heading,  but  limit 
changes. 

<5q  = Vi  - V 

limit  the  magnitude  of  6q  to  VMAX 
V = V + Sq 
Sq  = Hi  - H 

limit  the  magnitude  of  Sq  to  HMAX 
H = H + Sq 
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If  no  air  data  inputs,  check  for  manual  speed  and  heading  entries. 
«Sq  = Vo  - V 
If  6q  ^ 0,  set  V = Vo 
6q  - Ho  - H 

If  6q  ^ 0,  then  set  H = Ho 

Look  for  current  manual  entry  of  wind  data,  Vw  and  Hw.  If  manual 
entry  of  wind  data  has  been  made  this  frame,  then  reset: 

Wx  ■ VVsin  Hw 

Wy  = -Vwcos  Hw 

Compute  extrapolation  velocity 

Ve  = (Va  + V)/2 

He  - (Ha  + H)/2 

(being  careful  of  the  discontinuity  at  360°) 

Vx  = Wx  - Ve*sin  He 
Vy  = Wy  + Ve*cos  He 

8.  GROUND  or  AIRBORNE:  determine  new  position  and  compute  new  para- 

meter values  for  use  during  next  frame, 

GROUND:  set  A0  = Ay 

AX  = Ax 

AIRBORNE:  set  A0  = Vy*T  + Ayr  + Ay 
AX  = Vx*T  + Ax»x  + Ax 

(bearing  in  mind  that  Ax,  Ay,  Ax,  Ay  will  be  non-zero 
only  at  end  of  frame  in  the  recursive  phase.) 

0=0+  (A0  - AX2*TAN)/Rm 

Get  parameters  (subroutine) 

X = X + AX*A5*Al/cos  0 
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If  air  data  inputs  available,  set  Z ■ Zi 
If  air  data  not  available,  set  Z ■ Zo 
GROUND:  set  0 * “ 0 

X = A 

9.  AIRBORNE:  determine  new  velocity  components. 

Va  - V 
Ha  = H 

Vx  “ Wx  - Va*sin  Ha 
Vy  = Wy  + Va*cos  Ha 
V0  = Vy/Rm 
VX  * Vx‘Al*A5/cos  0 

10.  State  check 

If  TN  - 1,  then 

If  time  state  = S,  set  CT  = -1. 

If  time  state  = U,  then 

If  CT  5 0,  set  CT  = 1 

If  CT  > 0,  set  CT  = CT  + 1,  and 

If  CT  CTS,  set  time  state  = S,  and 
set  CT  = -1. 

If  TN  = 0,  then 

If  CT  = +1,  set  CT  = -1 

If  CT  < 0,  or  if  CT  > 1,  then 

set  CT  = CT  -1,  and 

If  CT  < -CTU,  then 

set  time  state  = U 

(time  phase  will  be  gross  sync  next  frame) 
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If  position  state  = U,  then 


If  PN  = 1,  set  CP  = CP  + 1,  and 
If  CP  < 0,  set  CP  = +1 

If  CP  CPK,  set  position  state  = P,  and  set  CP  = 0. 

If  PN  = 0,  set  CP  = CP  -1,  and 
If  CP  < -CPU,  then  set 
CP  = 0 

position  phase  = start  up 
SM(x) , SM(y)  = 0 
Tl(x),  Tl(y)  = 0. 

If  position  state  = P,  then 

If  PN  = 0,  then 

set  CP  = CP  + 1 

If  CP  >_  CPU,  and  unit  is  AIRBORNE,  then  set 
CP  = 0 

position  phase  = start  up 
position  state  ■ U 
SM(x) , SM(y)  = 0 
TI(x) , Tl(y)  = 0. 

If  PN  = 1,  then  set  CP  = 0. 

11.  NON-MASTER:  mode  check 

If  either  TN  or  PN  is  zero,  ££  if  operating  mode  f NORMAL,  or  if 
selected  mode  ^ NORMAL,  then  go  to  mode  check  subroutine. 

Otherwise,  proceed  without  checking  mode. 

12.  Zero  sums,  sample  counts  and  feedback 

Set  d,  dx,  dy  and  dt  to  zero 
Set  cx,  cy,  cxy,  CX2  and  CY2  to  zero 
Set  N,  NS,  NT,  NSP,  NSU,  and  NUP  to  zero 
Set  TF,  XF  and  YF  to  zero 
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13.  Prepare  new  position  report  for  transmission  at  time  t (radio 
clock),  containing  current  state,  current  position,  slot  number,  ID, 
task,  MIS  indicator,  etc.  (MIS  indicator  is  always  set  to  one  in  the 
outgoing  message  at  MASTER  and  REFERENCE).  The  position  loaded  is, 

Pt  = (0t,  Xt,  Z)  where 


0t  = 0 - 0r 
Xt  = X - Xr 

Then  if  NON-REFERENCE,  set  MIS  * 0. 

14.  Check  slot  assignment 

AS  = (Sa  - S)  modulo  # forward  slot  adjustment 

S = Sa  assigned  slot 

If  AS  ^ 0,  then 

t = t + T1  • AS  modulo  x position  report  time 

adjust  value  of,  but  do  not  set,  end  of  frame  interrupt 


Teoc  = Teoc  + T1  • AS 

AIRBORNE:  extrapolate 

txp  = T1  • AS 

time  interval 

0 = 0 + V0  • txp 

latitude 

X = X + VX  • txp 

longitude 

Adjust  value,  but  do  not  set. 

transmission  interrupt 

Tip  = Teoc  + 6p  - 6B  + At  + AC 


15.  Set  Interrupts 

If  operating  mode  ^ QUIET,  set  transmission  interrupts 
Tip  (just  computed) 

If  operating  mode  is  RANGING,  proceed  to  ranging  interro- 
gation subroutine. 


JL 
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15.  Set  Interrupts 


If  operating  mode  ^ QUIET,  set  transmission  Interrupts 
Tip  (just  computed) 

If  operating  mode  is  RANGING,  proceed  to  ranging  interro- 
gation subroutine. 

Adjust  value  of,  and  set,  end  of  frame  interrupt 
Teoc  = Teoc  + At  + T2  + AC 
Set  AC  = 0 
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SECTION  V 


SUBROUTINES 


GENERAL 

Much  of  the  computation  alluded  to  in  the  foregoing  routines  is 
now  presented  in  detail  in  this  section  on  subroutines. 

The  first,  Parameters,  supports  both  the  initialization  and  the 
end  of  frame  processing. 

Geometry  and  Summation  support  message  processing. 

While  the  remaining  seven,  Position  Adjustment  2x2,  Position 
Adjustment  3x3,  Start,  Update,  Update  Ground,  Mode  Check  and 
Ranging  Interrogation  Set-Up  support  the  end  of  cycle  processing. 


PARAMETERS 

This  subroutine  is  used  by  the  initialization  routine  and  the 
end  of  cycle  processing  routine.  It  computes  parameters  which  are 
a function  of  latitude:  Rm,  meridional  radius  of  curvature,  rinv, 

inverse  mean  radius  of  curvature,  and  the  factor  TAN.  It  uses  the 
local  unit's  latitude,  0,  and  the  constant  e,  (eccentricity  squared) 
and  the  fixed  constants,  A2  and  A3,  computed  in  the  initialization 
routine. 

A4  = (1  - e • sin^  0) 

A5  = /A4 

A6  = A5  • A4 

Rm  = A2/A6 


rinv  = A4  ‘A3 

TAN  = 1/2  • A5  • A1  • tan  0 


GEOMETRY 


For  position  reports,  the  geometry  subroutine  computes  the 
straight  line  distance,  Rc,  between  the  local  unit's  updated  position. 
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p'  = (0',  X , Z ) and  the  position  contained  in  message  received, 

Pj  = (0j , X j , Zj).  It  also  computes  the  sine  and  cosine  of  the 
bearing  angle  (with  respect  to  north)  from  p'  to  Pj.  (Adapted  from 
Reference  5.) 

x = (X  - Xr  - Xj)  • Nc  • cos(0j  + 0r) 

A0  = 0j  + 0r  - 0 

y - A0  • Rm  + x2  • TAN  + A02  • DTERM 

2 2 
RS2  = x + y 

G1  - 1 + Z • rTiiv 

G2  = 1 + Zj  • rinv 

Rc  • G2  • RS2  + (Zj  - Z)^  computed  range 

Rcinv  = 1/Rc 
SINY  = x* Rcinv 
COS'?  = y* Rcinv 

For  Loran  inputs  the  geometry  subroutine  computes  the  surface 
range  between  the  local  unit's  updated  position,  0',  X',  and  the 
Loran  transmitter,  0^,  X^,  using  the  Andoyer-Lambert  formula. 

1 ® f 

W = sin  0^  • sin  0 + cos  0^,  • cos  0 • cos  (X  - X^) 

XI  = arc  cosine  W 

Y1  - sin  XI 

G3  - sin  0T  + sin  0 

» 

G4  = sin  0^  - sin  0 

PI  = (3 *Y1  - X1)*K/(1  + W) 

(Where  K = 0.5602164710  x 10  "*) 

P2  = (3*Y1  + X1)*K/(1  - W) 

RC  = (XI  + P1*G32  - P2*G42)* 3443. 93358  Nautical  miles 
SINY  = cos  0T  • sin  (X*  - Xt>/Y1 

» I » 

COSY  = -(cos  0T  • sin  0 • cos  (X  - XT>  - sin  0T  • cos  0 )/Yl 
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SUMMATION 


This  routine  is  entered  after  the  measured  range,  Rt,  the  com- 
puted range,  Rc,  and  the  sine  and  cosine  of  the  bearing  angle,  SIN'P 
and  COS'?,  have  been  computed.  Direction  cosines  and  measurement 
factors  are  computed  and  added  to  the  running  sums. 

1.  The  measurement  is  qs  = Rt  - Rc 

If  CT  = 0,  1 or  2,  or  if  CT  £ -CTU,  skip  to  item  2. 

Otherwise  test  magnitude  of  qs. 

If  state  is  SP,  and  if  |qs|  <_  QMAX,  skip  to  item  2. 

If  state  is  not  SP,  and  if  |qs|  QBAD,  skip  to  item  2. 

Otherwise,  do  not  enter  this  datum  into  the  sample. 
Furthermore, 

Set  NSP  = NSP  - 1 

Set  state_j  to  UU  in  the  data  source  library 
Return  to  main  program. 

2.  Set  basic  weight,  according  to  source  and  type. 

WT^  = 1 master,  reference  or  Loran  data 

WT^  = 2 ground 
WT^  = 4 airborne 
Then  4 = WTi 

If  source  is  not  master  or  Loran,  and  if  normal  mode,  or  if 
synchronized  ranging  reply,  add  to  the  basic  weight. 

4 = 4 + sttj  - 2stXj  •SIN'l'  + 2sty^  • COS'P 

w = 1/4 

If  synchronized  ranging  reply  add  to  sums 

Nt  = Nt  + w 
dt  = dt  + w*dt 
4 = WT^  (reset) 
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If  source  is  ground  or  airborne,  and  if  normal  mode  or  if  ranging 
reply  with  known  position,  add 

C = C + sxXj'SINY2  - 2sxy^  ‘SINY’COSY  + syy^ *COSY2 

3.  Invert  to  form  weighting  factor 
w = 1/? 


4.  If  normal  mode,  or  if  ranging  reply  with  known  position, 

NS  = NS  + 1 
N = N + w 
cx  = cx  - wSINY 

cy  = cy  + wCOSY 

cxy  = cxy  - wSINY*  COSY 
CX2  = CX2  + w*  SINY*  SINY 
CY2  = CY2  + w*  COSY* COSY 
d = d + w*qs 
dx  = dx  - w*qs*SINY 

dy  = dy  + w*qs*COSY 


POSITION  ADJUSTMENT  2x2 

This  subroutine  provides  adjustment  factors  DX  and  DY  for  AIRBORNE 
units  which  are  in  state  SU  or  SP  or  when  operating  in  the  ranging 
mode.  It  is  also  used  for  feedback  determination  at  the  MASTER  unit. 

It  provides  a least  squares  linear  unbiased  estimate  of  position  error, 
assuming  synchronized  timing,  by  solving 


« 

-1 

. 1 

DX 

CX2  cxy 

dx 

DY 

. cxy  CY2 

. dy. 

where  the  terms  on  the  righthand  side  of  the  equation  are  the  sums  of 
products  of  direction  cosines  and  error  measurements  provided  by  the 
summation  subroutine,  which  operates  during  the  data  gathering  process. 
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1. 


El  = CX2  • CY2  - (cxy)z 

2.  If  | El | < DM2,  set  DX,  DY  and  PN  to  zero  and  exit 

3.  If  | El  | >^DM2,  set  PN  = 1,  and  compute 

DX  = (dx  • CY2  - dy  • cxy)/El 
DY  = (dy  • CX2  - dx  • cxy)/El 

POSITION  AND  TIME  ADJUSTMENT  3x3 

This  subroutine  provides  the  position  adjustment  factors  DX  and 
DY  for  GROUND  units,  the  time  and  position  adjustment  factors  DR,  DX 
and  DY  for  AIRBORNE  units  with  state  UU  or  UP.  It  continues  to  pro- 
vide the  time  adjustment  factor  DR  for  AIRBORNE  units  in  state  SU  or 
SP.  It  provides  a least  squares  linear  unbiased  estimate  of  time  and 
position  errors  by  solving 


dr' 

’ N 

CX 

cy  ' 

-1 

r d ' 

DX 

= 

cx 

CX2 

cxy 

dx 

DY 

r 

O 

cxy 

CY2 

dy 

where  the  terms  on  the  righthand  side  of  the  equation  are  sums  of  pro- 
ducts of  direction  cosines  and  error  measurements  provided  by  the  sum- 
mation subroutine,  which  operates  during  the  data  gathering  process. 


El 

- CX2 

• CY2 

- (cxy)2 

E2 

= cy 

• cxy  - 

cx 

• CY2 

E3 

= cx 

• cxy  - 

cy 

• CX2 

DEL  - N 

• El  + 

cx  • 

E2  + cy  • E3 

If 

| DEL  | 

< DM3, 

set 

DR, 

DX,  DY, 

TN, 

PN  and  GDOP  to 

If 

| del] 

1 DM3, 

compute 

DR  * Clinv(El*d  + E2*dx  + E3*dy)/DEL 
GDOP  = /El /DEL 
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4.  X2 


= N • CY2  - (cy)2 
X3  = cx*cy  - N cxy 
Y3  = N*CX2  - (cx)2 
DX  = (E2*d  + X2*dx  + X3*dy)/DEL 
DY  = (E3*d  + X3*dx  + Y3*dy) /DEL 

START 

The  sums  and  items  that  must  be  saved  during  the  start-up  phase 
are  labelled  and  identified: 

SN  - Zwi 

STA  - Ew^'t^ 

STQ  - Ew1»x2 

SDS  - Ew^'Ds 

STDS  - Ew^'T^’Ds^ 

SM  - frame  count  after  first  estimate,  Ds^,  obtained 
TI  - — time  interval 

M - control  parameter 
t - frame  duration 

Initially,  items  SN,  STA,  STQ,  SDS,  STDS,  SM  and  TI  are  set  to  zero. 
Since  the  same  logic  that  starts  up  system  time,  also  starts  up  air- 
borne position  in  x and  y,  we  really  have  three  sets  of  the  above 
seven  items.  When  referred  to  they  will  be  subscripted  — 1 for  sys- 
tem time,  2 for  x position,  and  3 for  y position. 

Subroutine  Start  is  entered  with  Index  i set  to  1,  2,  or  3,  for 
t,  x,  or  y,  and  has  the  appearance 
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Start 


TIi  = TIi  + t 
As,  As  = 0. 

If  oSQ^  = 0,  there  was  no  solution. 

If  SN1  i 0,  then  set  SMi  - SMi  + 1. 

Return. 

If  SQ^  # 0,  then  set 
w£  = l/aSQi 
SN±  = SN±  + w± 

SDS^  = SDS^  + w^*Ds. 

If  airborne  unit,  or  if  ground  or  reference  unit  with 
Index  i = 1,  then  set 

STA1  = STAi  + wi*TIi 

STQi  = STQi  + wi*(TIi)2 

STDSi  = STDS1  + wi*TIi*Ds 

If  ground  unit  and  Index  i = 2 or  3,  set 

STA . , STDS.  = 0 
i’  l 

STQi  = 1. 

SM±  « SM±  + 1. 

If  SM^  M,  then  compute, 

2 -4 

6s  = SNi*STQi  - (STA1)  : If  6 < 10  , return. 

a±  = STQi/6s 
b±  - STAi/6s 
ci  = SI^/Ss 
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As  = c^'STDS^  - b^*SDS^ 

As  - ai*SDS±  - b1*STDS±  + TI^As 

If  i = 1,  advance  time  to  phase  3,  and  set  time  state  to  S 

If  i ■ 2,  advance  position  to  phase  3,  and  set  position 
state  to  P. 

Return. 


UPDATE 

This  subroutine  updates  the  covariance  elements  and  computes  ef- 
fective smoothing  constants.  It  is  entered  every  frame  while  in  the 
recursive  phase,  whether  or  not  a solution  is  obtained.  It  is  used 
by  airborne  units  for  both  time  and  position  variables,  but  ground 
and  reference  units  use  it  only  for  variables  of  time.  Subroutine 
Update  is  entered  with  Index  i set  to  1,  2,  or  3.  The  indexed  smooth- 
ing constants  k,  kp  and  kv  have  been  identified  in  item  10  of  the 
initialization  routine  on  page  36.  Exactly  the  same  indexing  scheme 
is  extended  to  the  solution  variance,  the  effective  smoothing  con- 
stants and  the  covariance  matrix  as  shown  in  Table  I,  following. 


TABLE  I 

INDEXING  INTERPRETATIONS 


ITEM 

INTERPRETATION 

1-system  time 

2-x  position 

3-y  position 

a 

at 

ax 

ay 

b 

bt 

bx 

by 

c 

ct 

cx 

cy 

aSQ 

aSQt 

aSQx 

°SQy 

a 

at 

ax 

ay 

e1 

et 

6x 

3y 

Hoping  not  to  cause  confusion,  6 from  here  on  usually  means  (S/a). 
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The  subroutine  then  proceeds 


Update 

I 

b * c^*tf  + b^ 

• i 

a = (b  + b^) *Tf  + a^ 
If  aSQ^  = 0,  then 

I 

= k^*a 

b±  ■ ki-b' 

°i  = ki-ci 

°i  ■ kpi 
ei/x  = kv^x 

End. 


If  oSQ^  f 0,  then 


c = c±  + ki(ai*c1  - bi*bi)/oSQi 


6 = 1 + k *a  /aSQ. 


k 

a. 


\/6 

• » 

k *a 


i » 

b^  = k *b 

t i 

= k *c 

ai  " V0SQi 

3.^/t  = 


Care  must  be  exercised  to  prevent  descending  values  of 
c-£  from  dropping  below  the  current  non-zero  steady  state 
level,  which  is  oSQ* (k^  - l)3/k^ 

End. 

Return. 


69 


UPDATE  GROUND 


This  subroutine  updates  the  covariance  elements  and  computes  the 
effective  smoothing  constants  required  by  a ground  unit  in  position 
determination.  It  is  entered  with  Index  i set  to  2 or  3 and  uses  the 
same  indexing  structure  as  previously  described  for  subroutine  Update 
in  Table  I.  It  proceeds: 

Update  Ground 

If  aSQ^  = 0,  then 

ai ' Vai 

ai  ■ kn 

End. 

If  oSQj^  t 0 

ai  = aSQ1*ki*ai/(0SQi  + ki*ai^ 

“i  = ai/aSQi 
End. 

Return. 

MODE  CHECK 

The  mode  check  subroutine  determines  the  preferred  mode,  based  on 
available  data  sources,  then  considers  the  selected  mode  (switch  set- 
ting) and  sets  the  operating  mode. 

1.  MASTER:  set  operating  mode  to  NORMAL  and  exit. 

2.  REFERENCE: 

If  NSP  ^ 0, 

Preferred  mode  is  Normal 
Go  to  4. 
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If  NSP  = 0,  check  master  in  sight  (last  frame) 

If  MIS  = I 

set  MIS  = 0 (off) 

preferred  mode  is  Normal,  go  to  4. 

If  MIS  = 0,  check  for  SU  source 

If  NSU  ^ 0,  preferred  mode  is  RANGING,  go  to  4. 

If  NSU  «*  0,  check  own  state. 

If  state  * SP,  preferred  mode  is  NORMAL,  go  to  4. 

If  state  = UP,  preferred  mode  is  the  operating  mode, 

go  to  4. 

3.  GROUND  or  AIRBORNE: 

If  TN  = 1,  check  sample  sizes: 

If  NSP  >_  4,  preferred  mode  is  NORMAL 
If  NSP  = 3,  then 

If  position  state  P,  preferred  mode  is  NORMAL 
If  position  state  U,  preferred  mode  is  RANGING 
If  TN  = 0,  or  if  NSP  < 3,  test  for  possible  use  of  ranging  mode: 

If  GROUND  unit  with  position  state  P,  preferred  mode  is  NORMAL. 
If  NSP  + NSU  ^ 0,  preferred  mode  is  RANGING. 

If  NSP  + NSU  = 0,  test  own  state 

If  state  synched  (SU  or  SP) , and 
AIRBORNE:  test  NUP, 

If  NUP  ^ 0,  preferred  mode  RANGING 
If  NUP  * 0,  preferred  mode  NORMAL 
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GROUND:  test  NUP, 


If  NUP  >_  2 , preferred  mode  RANGING 

If  NUP  < 2,  preferred  mode  NORMAL 

If  state  unsynched  (UP  or  UU) , the  preferred  mode 
is  the  operating  mode. 

4.  All  non-master  units:  set  operating  mode. 

If  preferred  mode  is  QUIET,  set  operating  mode  to  QUIET. 

(Optional  - if  selected  mode  NORMAL  or  RANGING, 
display  operating  mode  = QUIET.) 

If  mode  unselected  (switch  setting) , set  operating  mode 
to  preferred  mode. 

(Optional  - display  operating  mode.) 

If  preferred  not  QUIET,  and  mode  not  unselected,  set 
operating  mode  to  the  selected  mode. 

(Optional  - If  operating  mode  not  the  same  as  the 
preferred  mode,  display  preferred  mode.) 

5.  Return  to  end  of  cycle  processing. 


RANGING  INTERROGATION  SET-UP 

A maximum  of  three  data  sources  may  be  interrogated.  Four  time 
slots  are  available  — one  interrogation  slot  and  three  reply  slots. 

The  slot  numbers  will  be  paired  with  ID  numbers  in  the  interro- 
gation table:  SID^,  SID2,  and  SID3.  Entries  may  have  been  made  to 

this  table  during  message  processing.  In  any  case,  attempt  to  fill 
the  table  as  much  as  possible,  up  to  three  entries. 

1.  Set  NI  = NSP 

If  NI  >_  3,  set  NI  = 3 and  skip  to  3. 

If  REFERENCE,  and  NI  ^ 0,  skip  to  3. 
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If  NSU  ^ 0,  add  synchronized  source  to  table. 

Set  NI  « NI  + 1 

Scan  data  source  library  for  source  with  state  SU  and 
enter  IDj  into  interrogation  table  location  SID.  (in- 
dexed by  NI) . 

REFERENCE:  skip  to  3. 

2.  If  NI  < 3:  attempt  to  add  to  table 

If  NUP  > 0,  add  source  with  known  location. 

Set  NI  = NI  + 1 

Scan  data  source  library  for  source  with  state  UP, 
and  enter  IDj  into  interrogation  table  location  SID. 
(indexed  by  NI) 

Set  NUP  = NUP  - 1 

Return  to  2. 

If  NUP  = 0,  skip  to  3. 

If  NI  ^ 3,  proceed. 

3.  If  NI  ^ 0,  make  up  the  interrogation  message  and  determine  trans- 
mission time. 

A.  Compute  the  transmission  time,  ti,  radio  clock. 

modulo  // 

ti  = t + Tl (Si  - S) 

\ 

modulo  T 

B.  Set  the  transmit  interrupt  to 

modulo  # 

/ 

Tir  = Tip  + Tl(Si  - S) 
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The  interrogation  message  will  contain,  in  the  preamble,  sender  ID, 
slot  Si  and  message  type;  then  in  the  body  of  the  message,  the  addres- 
sees, and  reply  slots,  SID^,  Sr^,  SID2,  Sr2,  SID^,  and  Sr^.  The  in- 
terrogation table  will  be  the  form  of : 


SID1 

state^ 

«1 

SJl 

Si 

Sri 

ti 

sid2 

state2 

S*2 

Si 

Sr2 

ti 

SID3 

state^ 

tj3 

«3 

Si 

Sr3 

ti 
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SECTION  VI 


PARAMETERS 

ALPHABETIC  PARAMETER  LISTING 

The  following  alphabetic  parameter  listing  is  provided  as  a pro- 
grammer's aid.  An  attempt  is  made  to  identify  important  parameters 
and  indicate  in  which  routine  or  subroutine  they  are  computed,  set 
or  reset. 

The  following  abbreviations  are  employed  to  indicate  which  routine 
computes,  sets,  alters  or  resets  the  parameter. 


Abbreviation 

Routine  or  Subroutine 

D 

Enter  Data  Phase 

E 

End  of  Frame  Processing 

G 

Geometry 

I 

Initialization 

I' 

Reinitialization 

M 

Message  Processing 

M' 

Message  Preprocessing 

MD 

Mode  Check 

P 

Parameters 

R 

Ranging  Interrogation  Set-Up 

S 

Summation 

ST 

Start 

U 

Update 

UG 

Update  Ground 

2 

Position  Adjustment  2x2 

3 

Position  Adjustment  3x3 

Blank 

Program  Constant 
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Following  this  list , certain  parameters  have  been  singled  out  and 
collected  into  more  logical  groupings  for  further  definition  and 


clarification. 

Parameter 

Routine 

Description 

a 

I 

ellipsoid,  semi -major  axis, 
converted  units 

ai 

ST,U,UG 

variance  (t,  x or  y) 

A1 

I 

1/a 

A2 

I 

a(l  - e) 

A3 

I 

1/  (a/r^""e) 

A4 

P 

2 

1 - e sin  0 

A5 

P 

(1  - e sin2  0)1/2 

A6 

P 

(1  - e sin2  0)3/2 

bi 

ST  ,U 

• • • 

covariance  (tt,  xx  or  yy) 

c 

velocity  of  light  in  vacuum 

ci 

ST,U 

• • • 

variance  (t,  x or  y) 

COS'F 

G 

cosine,  bearing  angle  to  source 

CP 

I,I',E 

counter  for  position  state 

CPK 

cycles  to  advance  position  state 

CPU 

cycles  to  drop  position  state 

CT 

1,1’  ,E 

counter  for  time  state 

CTQ 

cycles  to  force  mode  to  QUIET 

CTS 

1,1' 

cycles  to  advance  time  state 

CTSG 

airborne  and  ground  CTS 

CTSR 

reference  and  master  CTS 
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rameter 

Routine 

Description 

CTU 

I, I* 

cycles  to  drop  time  state 

CTUG 

airborne  and  ground  CTU 

CTUR 

reference  and  master  CTU 

cx 

sum  of  cos  x,  direction  cosine 
factor 

cxy 

I,I’,E,S 

sum  of  (cos  x) • (cos  y) , direc- 
tion cosine  factor 

CX2 

I,I',E,S 

2 

sum  of  cos  x,  direction  cosine 
factor 

cy 

I,I*,E,S 

sum  of  cos  y,  direction  cosine 
factor 

CY2 

I.I'.E.S 

2 

sum  of  cos  y,  direction  cosine 
factor 

Cl 

I 

mean  propagation  velocity 

Clinv 

I 

1/Cl 

d 

I.I'.E.S 

sum  of  range  discrepancy  meas- 
urements 

DEL 

3 

determinant  of  3 x 3 matrix 

DMAX 

maximum  clock  rate  adjustment 

DM2 

minimum  denominator  size,  2x2 
matrix 

DM3 

minimum  denominator  size,  3x3 
matrix 

DMA 

I.I' 

maximum  DR,  synchronized 

DM5 

trouble  indication 

DR 

E,3 

estimated  timing  error 

Ds 

E 

error  estimate 
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Parameter  Routine 


Description 


dt 


I,I\M,E 


sum  of  time  discrepancy  meas- 
urements 


DTERM 

dx 


DX 

dy 


DY 


I,G 

D term  In  geodetic  equation 

I,I\E,S 

sum  of  x component,  range  dis- 
crepancy 

2,3 

estimated  west  position  error 

I,I',E,S 

sum  of  y component,  range  dis- 
crepancy 

2,3 

estimated  north  position  error 

e 


I 


eccentricity  squared  (of  ellip- 
soid) 


El 


E2 

E3 

f 

FLAT 


2,3 


3 

3 

I 


denominator  of  2 x 2 matrix, 
equal  to  cofactor  used  in  com- 
puting DEL 

co factor  used  in  computing  DEL 

co factor  used  in  computing  DEL 

flattening  (of  the  ellipsoid  at 
the  poles) 

1/f 


GDOP 

H 

Ha 

He 


3 

I,E 

E 

E 


geometric  dilution  of  precision 

current  indicated  heading  in  use 

assumed  heading 

extrapolation  heading,  end  of 
frame 


Hi 

Hj 


indicated  heading,  wired  in 
(optional) 

source  heading 
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Parameter 

Routine 

Description 

HMAX 

maximum  heading  adjustment 

Ho 

D 

initial  heading  at  program  start 

Hw 

D 

input  wind  direction 

i 

E 

t,  x or  y 

ID 

D 

unit  identification 

IDj 

M 

data  source  identification 

IDr 

M 

data  source  identification 
ranging 

IND 

I,I\M,E 

data  received  indicator 

INDEX 

index  of  refraction,  mean 
atmosphere 

kda 

steady  state  g^/a^  airborne 

kdg 

" " " ground 

kdr 

M " " reference 

kdl 

11  11  11  master 

kpa 

position  discount  factor,  air 

kpal 

steady  state  airborne 

kpg 

position  discount  factor,  ground 

kpgl 

steady  state  ground 

kp-L 

1,1' 

steady  state 

kp2 

1,1' 

it  it  a 

X 

kp3 

1,1' 

ti  »»  a 

y 

master,  position  feedback  smooth- 
ing 


kpm 
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Routine 


Description 


Parameter 

kta 

ktal 

ktg 

ktgl 

ktm 

ktr 

ktrl 

ktl 


ktll 

kva 


MIS 

MQ1 


MQ2 


MRE 


time  discount  factor,  air 

steady  state  airborne 

time  discount  factor,  ground 

steady  state  ground 

master,  time  feedback  smoothing 

time  discount  factor,  reference 

steady  state  reference 

time  discount  factor,  master 

steady  state  master 

steady  state  $ /a  airborne 
P P 


1,1' 

steady  state  8t/at 

1,1' 

" " 8 /a 

X X 

1,1' 

" " 8 /a 

y y 

I.I' 

time  discount  factor 

I.I' 

x position  discount  factor 

1,1* 

y position  discount  factor 

ST 

frame  span  in  start  phase 

M,E,MD 

master  in  sight  indicator 

lower  action  level,  feedback 
control 

upper  action  level,  feedback 
control 

E 

mean  range  error 
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Parameter 

Routine 

Description 

N 

I,I’,M,E,S 

data  sample  size,  weighted 

Nc 

I 

mean  radius  of  curvature  at  sec- 
tor center 

NI 

R 

number  of  ranging  interrogations 

NS 

data  sample  size,  unweighted 

NSP 

I,I\M,E 

count  of  sources,  state  SP 

NSU 

I,I\M,E 

count  of  sources,  state  SU 

NT 

I,I\M,E 

weighted  count  of  synched  ranging 
replies 

NUP 

I,I',M,E,R 

count  of  sources,  state  UP 

Operating  Mode 

1,1* ,E,MD 

P 

reported  position  0,  X,  Z 

P' 

updated  position  0f , Xf,  Zf 

Pj 

M 

source  position  0 j , X j , Zj 

PN 

E 

position  data  processed  indicator 

pos  factor 

E 

pos  factor  x 

E 

accounts  for  time  dependency 
of  position  solution,  airborne 

pos  factor  y 

E 

j 

position  phase 

ST  ,E 

Preferred  mode 

MD 

Pt 

E 

transmitted  position  0t,  Xt , Z 

QMAX 

I.I* 

bad  data  limit  (state  SP) 

QBAD 

bad  data  limit  (state  not  SP) 

qs 

S 

measurement  of  range  discrepancy 
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Parameter 


Routine 


Description 


Rc 

G 

computed  range  or  position  dif- 
ference 

Rcinv 

G 

1/Rc 

Rcj 

M 

computed  range  in  data  source 
library 

rinv 

P 

inverse  mean  radius  of  curvature 

RIS 

1,1* ,M 

Reference  in  Sight 

Rm 

P 

meridional  radius  of  curvature 

Rs 

G 

surface  range 

RS2 

G 

(Rs)2 

Rt 

M 

timed,  or  measured,  one  way  range 

S 

I.I* 

position  reporting  slot 

Sa 

D,M 

slot  assignment 

SDSj^ 

ST 

Zw^#Ds 

Selected  Mode 

D 

Si 

I,I’,R 

ranging  interrogation  slot  (1,2,3) 

SID 

M,R 

ID  of  potential  interrogee  (1,2,3) 

SIGN 

E 

sign  agreement  (DR  and  MRE) 

sim' 

G 

sine  of  bearing  angle  to  source 

Sj 

M,R 

source  slot  number 

SMi 

E,  ST 

frame  count  since  1st  estimate 

SMA 

ellipsoid,  semi-major  axis 

SNi 

ST 

Ewi 
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Parameter 

Routine 

Sr 

I, I', MR, 

state 

I,I',E 

state_J 

M,R 

STDSi 

ST 

STQi 

ST 

STT 

E 

STX 

E 

STY 

E 

SXX 

E 

SXY 

E 

SYY 

E 

t 

1,1' ,E 

• 

t 

I,E 

T' 

H 

TAN 

P 

Task 

D 

Task_j 

D 

tc 

I 

tcomp 

M'  ,M 

Teoc 

I.I'.E 

TF 

I,I?,M,E 

Description 

ranging  reply  slot  (1,2,3) 
unit  time  and  position  status 
source  state 

EurvDsi 

rv,2i 

time  variance 

time-longitude  covariance 

time -latitude  covariance 

longitude  variance 

longitude-latitude  covariance 

latitude  variance 

position  reporting  time,  radio 
clock 

assumed  clock  rate 

adjusted  time  measurement 

(tan  0)  Jl  - e sin^ 

unit  task  designation 

source  task  designation 

current  computer  clock  reading 

computer  clock,  first  message  in 
cycle 

interrupt  time  for  end  of  frame 
processing 

feedback  time  adjustment 
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Parameter 


Routine 


ti 

TIi 

Tip 

Tir 

tj 

TN 

to 

tq 

tr 

trad 


R 

ST,E 

E 

E 

M,R 

E 

I 

M 

M 

M' 


time  factor  x E 

time  factor  xy  E 

time  factor  y E 

time  phase  E,ST 

Trr  M 

Ts  M 

Tsr  M 

txp  I,I',M 


Description 

ranging  interrogation  time, 
radio  clock 

time  interval  since  1st  estimate 

interrupt  time,  position  tx, 
computer  clock 

interrupt  time,  ranging  interr. , 
computer  clock 

message  received  time,  radio  clock 

timing  data  processed  indicator 

computer  clock  reading  at  pro- 
gram start 

mean  time,  ranging  interrogation 
and  reply 

ranging  reply  received  time 

radio  clock  reading,  first  mes- 
sage in  cycle 


accounts  for  position  dependency 
of  time  solution,  ground 


interrupt  time,  other  tx,  com- 
puter clock 

measured  transmit  time  interval 

transmit  time  reported  in  ranging 
reply 

extrapolation  time 
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Parameter 

Routine 

Description 

T1 

I >E 

assumed  slot  duration,  local 
radio  clock 

T2 

I »E 

assumed  frame  duration,  local 
radio  clock 

V 

I »E 

current  indicated  speed  in  use 

Va 

E 

assumed  speed 

Ve 

E 

extrapolation  speed,  end  of  frame 

Vi 

indicated  speed,  wired  in  (optional) 

Vj 

source  speed 

VMAX 

maximum  speed  adjustment 

Vo 

D 

initial  velocity  at  program  start 

Vx 

I »E 

speed  west 

Vy 

I »E 

speed  north 

Vw 

D 

input  wind  speed 

VX 

I *E 

longitudinal  speed  west 

V0 

I»E 

latitudinal  speed  north 

Wi 

ST 

weighting  factor 

WTjL 

S 

weighting  factor 

Wx 

I»E 

wind  speed  west 

Wy 

I >E 

wind  speed  north 

X 

G 

spheroidal  component  of  Rs , east 

XF 

I.I'.H.E 

position,  west,  feedback  adjustment 

X2 

3 

cofactor  used  in  computing  DEL 

X3 

3 

cofactor  used  in  computing  DEL 
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Routine 


Routine 

G 

Description 

spheroidal  component  of  Rs,  north 

I,I\M,E 

position,  east,  feedback  adjustment 

3 

cofactor  used  in  computing  DEL 

I,E 

reported  altitude 
mean  airborne  altitude 
altitude  of  sector  center 
indicated  altitude 

M 

source  altitude 

D»I 

initial  altitude 

E,U,UG 

position  on  time  smoothing  constant 

ST,U 

rate  smoothing  constant 
internal  delay 

transmission  interrupt  safety 
margin 

1*1' »M,E 

change  in  clock  advance 

E 

time  rate  estimate  adjustment 
end  of  frame  processing  delay 

E 

indicated  velocity  change 

1,1* 

slot  adjustment 

E,ST 

time  or  position  adjustment 

E,ST 

rate  adjustment 

E 

timing  estimate  adjustment 

E 

position  estimate  adjustment, 
west 
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«£ 


Parameter 

AY 

AX 

A0 

X 

X' 

Xc 

Xj 

Xo 

Xr 

Xt 

K 

T 

vp 

aSQi 

T 

ta 

0 

0’ 

0c 

0J 

0o 

0r 


Routine 

E 


E 

E 

I.I’.E 

I,M,E 


M 

D»I 

I,H,E 

G 

VP 

E,2 ,3 


E 

i.r.E 

I»M,E 


M 

D »I 


Description 

position  estimate  adjustment, 
north 

longitude  adjustment 

latitude  adjustment 

current  longitude 

updated  longitude 

longitude  of  sector  center 
(relative) 

longitude  of  source  (relative) 

initial  longitude  (relative) 

reference  longitude 

transmitted  longitude  (relative) 

longitude  of  Loran  transmitter 

propagation  velocity  estimate 

solution  variance 

frame  duration 

extrapolation  time 

current  latitude 

updated  latitude 

latitude  of  sector  center 
(relative) 

latitude  of  data  source  (relative) 
initial  latitude  (relative) 
reference  latitude 
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Parameter 


Routine 


Description 


0t 


I,M,E  transmitted  latitude  (relative) 


0T 

# 


G latitude  of  Loran  transmitter 

number  of  slots  per  frame 


PROGRAM  CONSTANTS 


Nominal 

Constant  Values  Description 


c 

299776  kilometers/sec 
161866.091  n.m./sec 

velocity  of  light  in  vacuum 

CPK 

64 

consecutive  frames  with  data, 
advance  position  state  to  P, 
air  and  ground 

CPU 

30 

consecutive  frames  no  data, 
drop  position  state  to  U,  air 
only 

CTQ 

3600 

consecutive  frames  no  data, 
force  mode  to  QUIET 

CTSG 

CTSR 

24  (air, ground)  j 
60  (ref, master) 

consecutive  frames  with  data, 
advance  time  state  to  S 

CTUG 

CTUR 

56  (air, ground)  , 
60  (ref, master) 

consecutive  frames  no  data, 
drop  time  state  to  U 

DMAX 

10  nanosec/sec 

maximum  clock  rate  adjustment 
synchronized 

DM2 

o 

rH 

minimum  denominator  size,  2 x 
position  adjustment 

DM3 

10"6 

minimum  denominator  size,  3 x 
time  and  position  adjustment 

DM4 

H 3 ps  (air, master) 
1 ys  (ground, ref) 

max  DR,  synchronized 

DM5 

1 vs 

trouble  indication 
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i 


Nominal 

Constant  Values 


Description 


FLAT 

298.25 

HMAX 

20  degrees 

INDEX 

1.00029 

QBAD 

500  n.m. 

QMAX 

1 3 nm  (air .master) 
1/4  nm  (ground, ref) 

SMA 

6,378,165  meters 

VMAX 

10  knots 

Za 

10,000  feet 

Zc 

200  feet 

6 

24  psec 

6B 

0.002  seconds 

6p 

0.06  seconds 

Xc 

5 minutes 

Xr 

71°  15'  west 
+4275  minutes 

MQl 

0 

MQ2 

20  nanosec 

1/f  defines  flattening 

maximum  heading  adjustment, 
before  velocity  smoothing 

index  of  refraction,  mean 
atmosphere 

maximum  discrepancy  for  non  SP 
units 

max  discrepancy  for  SP  units 

ellipsoid,  semi-major  axis 

maximum  speed  adjustment,  before 
velocity  smoothing 

mean  airborne  altitude 

altitude  of  sector  center  above 
sea  level 

internal  delay  (site  sensitive) 

transmission  interrupt  safety 
margin 

end  of  frame  processing  delay 

sector  center  relative  longitude, 
with  respect  to  reference 

reference  longitude 

lower  action  level,  feedback 
control 

upper  action  level,  feedback 
control 
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Nominal 

Constant  Values 


Description 


T 

1 second 

frame  duration 

0c 

3 minutes 

sector  center  relative  latitude 
with  respect  to  reference 

0r 

42°  30'  North 
(+2550  minutes) 

reference  latitude 

# 

100 

number  of  slots  per  frame 

SMOOTHING 

; CONSTANTS 
Nominal 

Constant 

Values 

Description 

kda 

.0006 

steady  state  0t/at  airborne 

kdg 

.0027 

steady  state  St/ott  ground 

kdr 

.0083 

steady  state  $t/at  reference 

kdl 

.0083 

steady  state  3t/at  master 

kpa 

1.15 

position  discount  factor,  airborne 

kpal 

.244 

steady  state  a airborne 
P 

kpg 

1.02 

position  discount  factor,  ground 

kpgl 

.0196 

steady  state  ground 

kpm 

.3 

master,  position  feedback 

kta 

1.025 

time  discount  factor,  airborne 

ktal 

.0482 

steady  state  at  airborne 

ktg 

1.05 

time  discount  factor,  ground 

ktgl 

.093 

steady  state  at  ground 

ktm 

.3 

master,  time  feedback 
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Constant 

Nominal 

Values 

Description 

ktr 

1.1 

time  discount  factor,  reference 

ktrl 

.17 

steady  state  reference 

ktl 

1.1 

time  discount  factor,  master 

ktll 

.17 

steady  state  at  master 

kva 

.017 

steady  state  a /$  airborne 
P P 
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